18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Wi-Fi Protected Setup - External Registrar 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2009, Jouni Malinen <j@w1.fi> 48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 58d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This program is free software; you can redistribute it and/or modify 68d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * it under the terms of the GNU General Public License version 2 as 78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * published by the Free Software Foundation. 88d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 98d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Alternatively, this software may be distributed under the terms of BSD 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * license. 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * See README and COPYING for more details. 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "includes.h" 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common.h" 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "base64.h" 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "uuid.h" 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "eloop.h" 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "httpread.h" 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "http_client.h" 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "http_server.h" 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "upnp_xml.h" 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps_i.h" 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps_upnp.h" 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps_upnp_i.h" 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps_er.h" 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_deinit_finish(void *eloop_data, void *user_ctx); 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_timeout(void *eloop_data, void *user_ctx); 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_sta_timeout(void *eloop_data, void *user_ctx); 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_process(struct wps_er_ap *ap, struct wpabuf *msg); 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_er_send_get_device_info(struct wps_er_ap *ap, 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void (*m1_handler)(struct wps_er_ap *ap, 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *m1)); 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_sta_event(struct wps_context *wps, struct wps_er_sta *sta, 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum wps_event event) 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wps_event_data data; 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_event_er_enrollee *ev = &data.enrollee; 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps->event_cb == NULL) 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->uuid = sta->uuid; 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->mac_addr = sta->addr; 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->m1_received = sta->m1_received; 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->config_methods = sta->config_methods; 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->dev_passwd_id = sta->dev_passwd_id; 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->pri_dev_type = sta->pri_dev_type; 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->dev_name = sta->dev_name; 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->manufacturer = sta->manufacturer; 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->model_name = sta->model_name; 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->model_number = sta->model_number; 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev->serial_number = sta->serial_number; 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps->event_cb(wps->cb_ctx, event, &data); 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wps_er_sta * wps_er_sta_get(struct wps_er_ap *ap, const u8 *addr, 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *uuid) 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_sta *sta; 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(sta, &ap->sta, struct wps_er_sta, list) { 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((addr == NULL || 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcmp(sta->addr, addr, ETH_ALEN) == 0) && 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (uuid == NULL || 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcmp(uuid, sta->uuid, WPS_UUID_LEN) == 0)) 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return sta; 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_sta_free(struct wps_er_sta *sta) 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_event(sta->ap->er->wps, sta, WPS_EV_ER_ENROLLEE_REMOVE); 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->wps) 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_deinit(sta->wps); 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->manufacturer); 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->model_name); 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->model_number); 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->serial_number); 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->dev_name); 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(sta->http); 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wps_er_sta_timeout, sta, NULL); 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->cred); 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta); 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_sta_remove_all(struct wps_er_ap *ap) 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_sta *prev, *sta; 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each_safe(sta, prev, &ap->sta, struct wps_er_sta, list) 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_free(sta); 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wps_er_ap * wps_er_ap_get(struct wps_er *er, 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct in_addr *addr, const u8 *uuid) 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(ap, &er->ap, struct wps_er_ap, list) { 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((addr == NULL || ap->addr.s_addr == addr->s_addr) && 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (uuid == NULL || 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcmp(uuid, ap->uuid, WPS_UUID_LEN) == 0)) 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ap; 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wps_er_ap * wps_er_ap_get_id(struct wps_er *er, unsigned int id) 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(ap, &er->ap, struct wps_er_ap, list) { 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->id == id) 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ap; 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_event(struct wps_context *wps, struct wps_er_ap *ap, 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum wps_event event) 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wps_event_data data; 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_event_er_ap *evap = &data.ap; 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps->event_cb == NULL) 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->uuid = ap->uuid; 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->friendly_name = ap->friendly_name; 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->manufacturer = ap->manufacturer; 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->manufacturer_url = ap->manufacturer_url; 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->model_description = ap->model_description; 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->model_name = ap->model_name; 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->model_number = ap->model_number; 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->model_url = ap->model_url; 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->serial_number = ap->serial_number; 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->upc = ap->upc; 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->pri_dev_type = ap->pri_dev_type; 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->wps_state = ap->wps_state; 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt evap->mac_addr = ap->mac_addr; 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps->event_cb(wps->cb_ctx, event, &data); 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_free(struct wps_er_ap *ap) 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(ap->http); 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = NULL; 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->location); 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->friendly_name); 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->manufacturer); 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->manufacturer_url); 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->model_description); 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->model_name); 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->model_number); 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->model_url); 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->serial_number); 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->udn); 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->upc); 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->scpd_url); 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->control_url); 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->event_sub_url); 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->ap_settings); 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap); 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_unsubscribed(struct wps_er *er, struct wps_er_ap *ap) 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Unsubscribed from AP %s (%s)", 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt inet_ntoa(ap->addr), ap->location); 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_del(&ap->list); 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_free(ap); 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er->deinitializing && dl_list_empty(&er->ap_unsubscribing)) { 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wps_er_deinit_finish, er, NULL); 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_deinit_finish(er, NULL); 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_unsubscribe_cb(void *ctx, struct http_client *c, 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_client_event event) 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap = ctx; 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (event) { 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_OK: 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Unsubscribed from events"); 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->subscribed = 0; 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_FAILED: 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_INVALID_REPLY: 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_TIMEOUT: 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to unsubscribe from " 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "events"); 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(ap->http); 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = NULL; 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Need to get rid of the AP entry regardless of whether we managed to 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * unsubscribe cleanly or not. 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_unsubscribed(ap->er, ap); 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_unsubscribe(struct wps_er *er, struct wps_er_ap *ap) 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *req; 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_in dst; 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *url, *path; 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char sid[100]; 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->event_sub_url == NULL) { 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: No eventSubURL - cannot " 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "subscribe"); 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto fail; 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http) { 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Pending HTTP request - cannot " 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "send subscribe request"); 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto fail; 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt url = http_client_url_parse(ap->event_sub_url, &dst, &path); 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (url == NULL) { 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to parse eventSubURL"); 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto fail; 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt req = wpabuf_alloc(os_strlen(ap->event_sub_url) + 1000); 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (req == NULL) { 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(url); 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto fail; 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt uuid_bin2str(ap->sid, sid, sizeof(sid)); 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_printf(req, 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "UNSUBSCRIBE %s HTTP/1.1\r\n" 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "HOST: %s:%d\r\n" 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "SID: uuid:%s\r\n" 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "\r\n", 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt path, inet_ntoa(dst.sin_addr), ntohs(dst.sin_port), sid); 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(url); 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_MSGDUMP, "WPS ER: Unsubscription request", 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(req), wpabuf_len(req)); 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = http_client_addr(&dst, req, 1000, 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_unsubscribe_cb, ap); 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http == NULL) { 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(req); 2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto fail; 2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtfail: 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Need to get rid of the AP entry even when we fail to unsubscribe 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * cleanly. 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_unsubscribed(ap->er, ap); 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wps_er_ap_settings * wps_er_ap_get_settings(struct wps_er *er, 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *uuid) 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap_settings *s; 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(s, &er->ap_settings, struct wps_er_ap_settings, list) 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(uuid, s->uuid, WPS_UUID_LEN) == 0) 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return s; 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wps_er_ap_cache_settings(struct wps_er *er, struct in_addr *addr) 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap_settings *settings; 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap = wps_er_ap_get(er, addr, NULL); 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap == NULL || ap->ap_settings == NULL) 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt settings = wps_er_ap_get_settings(er, ap->uuid); 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!settings) { 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt settings = os_zalloc(sizeof(*settings)); 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (settings == NULL) 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(settings->uuid, ap->uuid, WPS_UUID_LEN); 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_add(&er->ap_settings, &settings->list); 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&settings->ap_settings, ap->ap_settings, 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct wps_credential)); 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_er_ap_use_cached_settings(struct wps_er *er, 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap) 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap_settings *s; 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->ap_settings) 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt s = wps_er_ap_get_settings(ap->er, ap->uuid); 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!s) 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->ap_settings = os_malloc(sizeof(*ap->ap_settings)); 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->ap_settings == NULL) 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ap->ap_settings, &s->ap_settings, sizeof(*ap->ap_settings)); 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Use cached AP settings"); 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_remove_entry(struct wps_er *er, struct wps_er_ap *ap) 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Removing AP entry for %s (%s)", 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt inet_ntoa(ap->addr), ap->location); 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wps_er_ap_timeout, er, ap); 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_remove_all(ap); 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_event(er->wps, ap, WPS_EV_ER_AP_REMOVE); 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(ap->http); 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = NULL; 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->wps) { 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_deinit(ap->wps); 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps = NULL; 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_del(&ap->list); 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->subscribed) { 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_add(&er->ap_unsubscribing, &ap->list); 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_unsubscribe(er, ap); 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_free(ap); 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_timeout(void *eloop_data, void *user_ctx) 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er *er = eloop_data; 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap = user_ctx; 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: AP advertisement timed out"); 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_remove_entry(er, ap); 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_er_get_sid(struct wps_er_ap *ap, char *sid) 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos; 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char txt[100]; 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!sid) { 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: No SID received from %s (%s)", 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt inet_ntoa(ap->addr), ap->location); 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = os_strstr(sid, "uuid:"); 3848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!pos) { 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Invalid SID received from " 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s (%s): '%s'", inet_ntoa(ap->addr), ap->location, 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sid); 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 5; 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (uuid_str2bin(pos, ap->sid) < 0) { 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Invalid SID received from " 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s (%s): '%s'", inet_ntoa(ap->addr), ap->location, 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sid); 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt uuid_bin2str(ap->sid, txt, sizeof(txt)); 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: SID for subscription with %s (%s): %s", 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt inet_ntoa(ap->addr), ap->location, txt); 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_subscribe_cb(void *ctx, struct http_client *c, 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_client_event event) 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap = ctx; 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (event) { 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_OK: 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Subscribed to events"); 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->subscribed = 1; 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_get_sid(ap, http_client_get_hdr_line(c, "SID")); 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_use_cached_settings(ap->er, ap); 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_event(ap->er->wps, ap, WPS_EV_ER_AP_ADD); 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_FAILED: 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_INVALID_REPLY: 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_TIMEOUT: 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to subscribe to events"); 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(ap->http); 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = NULL; 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_subscribe(struct wps_er_ap *ap) 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *req; 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_in dst; 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *url, *path; 4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->event_sub_url == NULL) { 4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: No eventSubURL - cannot " 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "subscribe"); 4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http) { 4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Pending HTTP request - cannot " 4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "send subscribe request"); 4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt url = http_client_url_parse(ap->event_sub_url, &dst, &path); 4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (url == NULL) { 4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to parse eventSubURL"); 4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt req = wpabuf_alloc(os_strlen(ap->event_sub_url) + 1000); 4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (req == NULL) { 4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(url); 4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_printf(req, 4608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "SUBSCRIBE %s HTTP/1.1\r\n" 4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "HOST: %s:%d\r\n" 4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "CALLBACK: <http://%s:%d/event/%u/%u>\r\n" 4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "NT: upnp:event\r\n" 4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TIMEOUT: Second-%d\r\n" 4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "\r\n", 4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt path, inet_ntoa(dst.sin_addr), ntohs(dst.sin_port), 4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->er->ip_addr_text, ap->er->http_port, 4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->er->event_id, ap->id, 1800); 4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(url); 4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_MSGDUMP, "WPS ER: Subscription request", 4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(req), wpabuf_len(req)); 4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = http_client_addr(&dst, req, 1000, wps_er_http_subscribe_cb, 4748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap); 4758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http == NULL) 4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(req); 4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_get_m1(struct wps_er_ap *ap, struct wpabuf *m1) 4818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_parse_attr attr; 4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_parse_msg(m1, &attr) < 0) { 4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to parse M1"); 4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr.primary_dev_type) 4898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ap->pri_dev_type, attr.primary_dev_type, 8); 4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr.wps_state) 4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps_state = *attr.wps_state; 4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr.mac_addr) 4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ap->mac_addr, attr.mac_addr, ETH_ALEN); 4948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_subscribe(ap); 4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_get_device_info(struct wps_er_ap *ap) 5008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_send_get_device_info(ap, wps_er_ap_get_m1); 5028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_parse_device_description(struct wps_er_ap *ap, 5068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *reply) 5078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Note: reply includes null termination after the buffer data */ 5098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *data = wpabuf_head(reply); 5108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos; 5118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_MSGDUMP, "WPS ER: Device info", 5138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(reply), wpabuf_len(reply)); 5148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->friendly_name = xml_get_first_item(data, "friendlyName"); 5168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: friendlyName='%s'", ap->friendly_name); 5178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->manufacturer = xml_get_first_item(data, "manufacturer"); 5198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: manufacturer='%s'", ap->manufacturer); 5208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->manufacturer_url = xml_get_first_item(data, "manufacturerURL"); 5228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: manufacturerURL='%s'", 5238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->manufacturer_url); 5248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->model_description = xml_get_first_item(data, "modelDescription"); 5268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: modelDescription='%s'", 5278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->model_description); 5288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->model_name = xml_get_first_item(data, "modelName"); 5308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: modelName='%s'", ap->model_name); 5318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->model_number = xml_get_first_item(data, "modelNumber"); 5338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: modelNumber='%s'", ap->model_number); 5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->model_url = xml_get_first_item(data, "modelURL"); 5368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: modelURL='%s'", ap->model_url); 5378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->serial_number = xml_get_first_item(data, "serialNumber"); 5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: serialNumber='%s'", ap->serial_number); 5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->udn = xml_get_first_item(data, "UDN"); 5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: UDN='%s'", ap->udn); 5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = os_strstr(ap->udn, "uuid:"); 5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos) { 5458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 5; 5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (uuid_str2bin(pos, ap->uuid) < 0) 5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Invalid UUID in UDN"); 5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->upc = xml_get_first_item(data, "UPC"); 5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: UPC='%s'", ap->upc); 5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->scpd_url = http_link_update( 5548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt xml_get_first_item(data, "SCPDURL"), ap->location); 5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: SCPDURL='%s'", ap->scpd_url); 5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->control_url = http_link_update( 5588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt xml_get_first_item(data, "controlURL"), ap->location); 5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: controlURL='%s'", ap->control_url); 5608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->event_sub_url = http_link_update( 5628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt xml_get_first_item(data, "eventSubURL"), ap->location); 5638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: eventSubURL='%s'", ap->event_sub_url); 5648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_dev_desc_cb(void *ctx, struct http_client *c, 5688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_client_event event) 5698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap = ctx; 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *reply; 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ok = 0; 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (event) { 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_OK: 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt reply = http_client_get_body(c); 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (reply == NULL) 5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_parse_device_description(ap, reply); 5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ok = 1; 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_FAILED: 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_INVALID_REPLY: 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_TIMEOUT: 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to fetch device info"); 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(ap->http); 5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = NULL; 5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ok) 5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_get_device_info(ap); 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wps_er_ap_add(struct wps_er *er, const u8 *uuid, struct in_addr *addr, 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *location, int max_age) 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap = wps_er_ap_get(er, addr, uuid); 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap) { 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update advertisement timeout */ 6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wps_er_ap_timeout, er, ap); 6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(max_age, 0, wps_er_ap_timeout, er, ap); 6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap = os_zalloc(sizeof(*ap)); 6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap == NULL) 6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_init(&ap->sta); 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->er = er; 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->id = ++er->next_ap_id; 6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->location = os_strdup(location); 6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->location == NULL) { 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap); 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_add(&er->ap, &ap->list); 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->addr.s_addr = addr->s_addr; 6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ap->uuid, uuid, WPS_UUID_LEN); 6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(max_age, 0, wps_er_ap_timeout, er, ap); 6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Added AP entry for %s (%s)", 6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt inet_ntoa(ap->addr), ap->location); 6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Fetch device description */ 6298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = http_client_url(ap->location, NULL, 10000, 6308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_dev_desc_cb, ap); 6318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wps_er_ap_remove(struct wps_er *er, struct in_addr *addr) 6358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 6378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(ap, &er->ap, struct wps_er_ap, list) { 6388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->addr.s_addr == addr->s_addr) { 6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_remove_entry(er, ap); 6408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_remove_all(struct wps_er *er) 6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *prev, *ap; 6498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap_settings *prev_s, *s; 6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each_safe(ap, prev, &er->ap, struct wps_er_ap, list) 6518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_remove_entry(er, ap); 6528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each_safe(s, prev_s, &er->ap_settings, 6538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap_settings, list) 6548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(s); 6558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void http_put_date(struct wpabuf *buf) 6598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, "Date: "); 6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt format_date(buf); 6628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, "\r\n"); 6638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_resp_not_found(struct http_request *req) 6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *buf; 6698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = wpabuf_alloc(200); 6708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) { 6718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_request_deinit(req); 6728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, 6768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "HTTP/1.1 404 Not Found\r\n" 6778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Server: unspecified, UPnP/1.0, unspecified\r\n" 6788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Connection: close\r\n"); 6798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_put_date(buf); 6808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, "\r\n"); 6818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_request_send_and_deinit(req, buf); 6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_resp_ok(struct http_request *req) 6868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *buf; 6888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = wpabuf_alloc(200); 6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) { 6908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_request_deinit(req); 6918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, 6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "HTTP/1.1 200 OK\r\n" 6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Server: unspecified, UPnP/1.0, unspecified\r\n" 6978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Connection: close\r\n" 6988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Content-Length: 0\r\n"); 6998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_put_date(buf); 7008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, "\r\n"); 7018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_request_send_and_deinit(req, buf); 7028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_sta_timeout(void *eloop_data, void *user_ctx) 7068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_sta *sta = eloop_data; 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: STA entry timed out"); 7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_del(&sta->list); 7108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_free(sta); 7118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wps_er_sta * wps_er_add_sta_data(struct wps_er_ap *ap, 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr, 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_parse_attr *attr, 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int probe_req) 7188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_sta *sta = wps_er_sta_get(ap, addr, NULL); 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int new_sta = 0; 7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int m1; 7228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt m1 = !probe_req && attr->msg_type && *attr->msg_type == WPS_M1; 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta == NULL) { 7268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Only allow new STA entry to be added based on Probe Request 7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * or M1. This will filter out bogus events and anything that 7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * may have been ongoing at the time ER subscribed for events. 7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!probe_req && !m1) 7328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta = os_zalloc(sizeof(*sta)); 7358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta == NULL) 7368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 7378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->addr, addr, ETH_ALEN); 7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->ap = ap; 7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_add(&ap->sta, &sta->list); 7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt new_sta = 1; 7418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (m1) 7448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->m1_received = 1; 7458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->config_methods && (!probe_req || !sta->m1_received)) 7478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->config_methods = WPA_GET_BE16(attr->config_methods); 7488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->uuid_e && (!probe_req || !sta->m1_received)) 7498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->uuid, attr->uuid_e, WPS_UUID_LEN); 7508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->primary_dev_type && (!probe_req || !sta->m1_received)) 7518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->pri_dev_type, attr->primary_dev_type, 8); 7528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->dev_password_id && (!probe_req || !sta->m1_received)) 7538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->dev_passwd_id = WPA_GET_BE16(attr->dev_password_id); 7548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->manufacturer) { 7568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->manufacturer); 7578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->manufacturer = os_malloc(attr->manufacturer_len + 1); 7588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->manufacturer) { 7598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->manufacturer, attr->manufacturer, 7608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->manufacturer_len); 7618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->manufacturer[attr->manufacturer_len] = '\0'; 7628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->model_name) { 7668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->model_name); 7678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->model_name = os_malloc(attr->model_name_len + 1); 7688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->model_name) { 7698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->model_name, attr->model_name, 7708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->model_name_len); 7718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->model_name[attr->model_name_len] = '\0'; 7728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->model_number) { 7768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->model_number); 7778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->model_number = os_malloc(attr->model_number_len + 1); 7788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->model_number) { 7798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->model_number, attr->model_number, 7808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->model_number_len); 7818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->model_number[attr->model_number_len] = '\0'; 7828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->serial_number) { 7868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->serial_number); 7878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->serial_number = os_malloc(attr->serial_number_len + 1); 7888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->serial_number) { 7898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->serial_number, attr->serial_number, 7908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->serial_number_len); 7918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->serial_number[attr->serial_number_len] = '\0'; 7928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->dev_name) { 7968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->dev_name); 7978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->dev_name = os_malloc(attr->dev_name_len + 1); 7988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->dev_name) { 7998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->dev_name, attr->dev_name, 8008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->dev_name_len); 8018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->dev_name[attr->dev_name_len] = '\0'; 8028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wps_er_sta_timeout, sta, NULL); 8068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(300, 0, wps_er_sta_timeout, sta, NULL); 8078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (m1 || new_sta) 8098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_event(ap->er->wps, sta, WPS_EV_ER_ENROLLEE_ADD); 8108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return sta; 8128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_process_wlanevent_probe_req(struct wps_er_ap *ap, 8168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr, 8178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *msg) 8188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_parse_attr attr; 8208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: WLANEvent - Probe Request - from " 8228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR, MAC2STR(addr)); 8238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_buf(MSG_MSGDUMP, "WPS ER: WLANEvent - Enrollee's message " 8248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(TLVs from Probe Request)", msg); 8258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_validate_probe_req(msg, addr) < 0) { 8278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "WPS-STRICT: ER: Ignore invalid proxied " 8288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Probe Request frame from " MACSTR, MAC2STR(addr)); 8298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 8308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_parse_msg(msg, &attr) < 0) { 8338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to parse TLVs in " 8348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "WLANEvent message"); 8358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 8368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_add_sta_data(ap, addr, &attr, 1); 8398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_registrar_probe_req_rx(ap->er->wps->registrar, addr, msg, 0); 8408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_put_wlan_response_cb(void *ctx, struct http_client *c, 8448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_client_event event) 8458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_sta *sta = ctx; 8478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (event) { 8498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_OK: 8508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: PutWLANResponse OK"); 8518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 8528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_FAILED: 8538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_INVALID_REPLY: 8548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_TIMEOUT: 8558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: PutWLANResponse failed"); 8568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 8578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(sta->http); 8598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->http = NULL; 8608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char *soap_prefix = 8648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "<?xml version=\"1.0\"?>\n" 8658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "<s:Envelope xmlns:s=\"http://schemas.xmlsoap.org/soap/envelope/\" " 8668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "s:encodingStyle=\"http://schemas.xmlsoap.org/soap/encoding/\">\n" 8678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "<s:Body>\n"; 8688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char *soap_postfix = 8698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "</s:Body>\n</s:Envelope>\n"; 8708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char *urn_wfawlanconfig = 8718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "urn:schemas-wifialliance-org:service:WFAWLANConfig:1"; 8728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wpabuf * wps_er_soap_hdr(const struct wpabuf *msg, 8748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *name, const char *arg_name, 8758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *path, 8768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct sockaddr_in *dst, 8778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char **len_ptr, char **body_ptr) 8788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char *encoded; 8808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t encoded_len; 8818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *buf; 8828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (msg) { 8848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt encoded = base64_encode(wpabuf_head(msg), wpabuf_len(msg), 8858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &encoded_len); 8868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (encoded == NULL) 8878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 8888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 8898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt encoded = NULL; 8908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt encoded_len = 0; 8918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = wpabuf_alloc(1000 + encoded_len); 8948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) { 8958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(encoded); 8968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 8978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_printf(buf, 9008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "POST %s HTTP/1.1\r\n" 9018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Host: %s:%d\r\n" 9028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Content-Type: text/xml; charset=\"utf-8\"\r\n" 9038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Content-Length: ", 9048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt path, inet_ntoa(dst->sin_addr), ntohs(dst->sin_port)); 9058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *len_ptr = wpabuf_put(buf, 0); 9078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_printf(buf, 9088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " \r\n" 9098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "SOAPACTION: \"%s#%s\"\r\n" 9108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "\r\n", 9118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt urn_wfawlanconfig, name); 9128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *body_ptr = wpabuf_put(buf, 0); 9148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, soap_prefix); 9168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_printf(buf, "<u:%s xmlns:u=\"", name); 9178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, urn_wfawlanconfig); 9188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, "\">\n"); 9198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (encoded) { 9208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_printf(buf, "<%s>%s</%s>\n", 9218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt arg_name, (char *) encoded, arg_name); 9228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(encoded); 9238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return buf; 9268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_soap_end(struct wpabuf *buf, const char *name, 9308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *len_ptr, char *body_ptr) 9318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char len_buf[10]; 9338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_printf(buf, "</u:%s>\n", name); 9348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, soap_postfix); 9358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(len_buf, sizeof(len_buf), "%d", 9368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (int) ((char *) wpabuf_put(buf, 0) - body_ptr)); 9378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(len_ptr, len_buf, os_strlen(len_buf)); 9388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_sta_send_msg(struct wps_er_sta *sta, struct wpabuf *msg) 9428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *buf; 9448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *len_ptr, *body_ptr; 9458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_in dst; 9468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *url, *path; 9478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->http) { 9498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Pending HTTP request for STA - " 9508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ignore new request"); 9518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(msg); 9528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 9538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->ap->control_url == NULL) { 9568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: No controlURL for AP"); 9578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(msg); 9588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 9598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt url = http_client_url_parse(sta->ap->control_url, &dst, &path); 9628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (url == NULL) { 9638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to parse controlURL"); 9648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(msg); 9658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 9668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = wps_er_soap_hdr(msg, "PutWLANResponse", "NewMessage", path, &dst, 9698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &len_ptr, &body_ptr); 9708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(msg); 9718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(url); 9728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 9738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 9748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_printf(buf, "<NewWLANEventType>%d</NewWLANEventType>\n", 9758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt UPNP_WPS_WLANEVENT_TYPE_EAP); 9768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_printf(buf, "<NewWLANEventMAC>" MACSTR "</NewWLANEventMAC>\n", 9778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(sta->addr)); 9788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_soap_end(buf, "PutWLANResponse", len_ptr, body_ptr); 9808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->http = http_client_addr(&dst, buf, 1000, 9828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_put_wlan_response_cb, sta); 9838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->http == NULL) 9848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(buf); 9858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_sta_process(struct wps_er_sta *sta, struct wpabuf *msg, 9898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum wsc_op_code op_code) 9908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum wps_process_res res; 9928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res = wps_process_msg(sta->wps, op_code, msg); 9948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res == WPS_CONTINUE) { 9958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *next = wps_get_msg(sta->wps, &op_code); 9968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (next) 9978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_send_msg(sta, next); 9988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 9998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Protocol run %s with the " 10008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "enrollee (res=%d)", 10018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res == WPS_DONE ? "succeeded" : "failed", res); 10028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_deinit(sta->wps); 10038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->wps = NULL; 10048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res == WPS_DONE) { 10058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Remove the STA entry after short timeout */ 10068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wps_er_sta_timeout, sta, NULL); 10078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(10, 0, wps_er_sta_timeout, sta, 10088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL); 10098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_sta_start(struct wps_er_sta *sta, struct wpabuf *msg) 10158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_config cfg; 10178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->wps) 10198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_deinit(sta->wps); 10208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&cfg, 0, sizeof(cfg)); 10228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg.wps = sta->ap->er->wps; 10238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg.registrar = 1; 10248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg.peer_addr = sta->addr; 10258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->wps = wps_init(&cfg); 10278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->wps == NULL) 10288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 10298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->wps->er = 1; 10308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->wps->use_cred = sta->ap->ap_settings; 10318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->ap->ap_settings) { 10328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(sta->cred); 10338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->cred = os_malloc(sizeof(*sta->cred)); 10348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta->cred) { 10358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->cred, sta->ap->ap_settings, 10368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(*sta->cred)); 10378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->cred->cred_attr = NULL; 10388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(sta->cred->mac_addr, sta->addr, ETH_ALEN); 10398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta->wps->use_cred = sta->cred; 10408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_process(sta, msg, WSC_MSG); 10448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_process_wlanevent_eap(struct wps_er_ap *ap, const u8 *addr, 10488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *msg) 10498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_parse_attr attr; 10518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_sta *sta; 10528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: WLANEvent - EAP - from " MACSTR, 10548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(addr)); 10558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_buf(MSG_MSGDUMP, "WPS ER: WLANEvent - Enrollee's message " 10568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(TLVs from EAP-WSC)", msg); 10578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_parse_msg(msg, &attr) < 0) { 10598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to parse TLVs in " 10608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "WLANEvent message"); 10618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 10628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta = wps_er_add_sta_data(ap, addr, &attr, 0); 10658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta == NULL) 10668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 10678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr.msg_type && *attr.msg_type == WPS_M1) 10698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_start(sta, msg); 10708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (sta->wps) { 10718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum wsc_op_code op_code = WSC_MSG; 10728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr.msg_type) { 10738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (*attr.msg_type) { 10748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPS_WSC_ACK: 10758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op_code = WSC_ACK; 10768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 10778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPS_WSC_NACK: 10788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op_code = WSC_NACK; 10798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 10808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPS_WSC_DONE: 10818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op_code = WSC_Done; 10828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 10838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_process(sta, msg, op_code); 10868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_process_wlanevent(struct wps_er_ap *ap, 10918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *event) 10928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *data; 10948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 wlan_event_type; 10958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 wlan_event_mac[ETH_ALEN]; 10968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf msg; 10978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "WPS ER: Received WLANEvent", 10998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(event), wpabuf_len(event)); 11008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpabuf_len(event) < 1 + 17) { 11018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Too short WLANEvent"); 11028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 11038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data = wpabuf_mhead(event); 11068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wlan_event_type = data[0]; 11078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton((char *) data + 1, wlan_event_mac) < 0) { 11088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Invalid WLANEventMAC in " 11098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "WLANEvent"); 11108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 11118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_set(&msg, data + 1 + 17, wpabuf_len(event) - (1 + 17)); 11148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (wlan_event_type) { 11168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 1: 11178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_process_wlanevent_probe_req(ap, wlan_event_mac, &msg); 11188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 11198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case 2: 11208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_process_wlanevent_eap(ap, wlan_event_mac, &msg); 11218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 11228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 11238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Unknown WLANEventType %d", 11248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wlan_event_type); 11258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 11268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_event(struct wps_er *er, struct http_request *req, 11318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int ap_id) 11328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap = wps_er_ap_get_id(er, ap_id); 11348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *event; 11358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_reply_code ret; 11368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap == NULL) { 11388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: HTTP event from unknown AP id " 11398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%u", ap_id); 11408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_resp_not_found(req); 11418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 11428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_MSGDUMP, "WPS ER: HTTP event from AP id %u: %s", 11448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap_id, http_request_get_data(req)); 11458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event = xml_get_base64_item(http_request_get_data(req), "WLANEvent", 11478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &ret); 11488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (event == NULL) { 11498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Could not extract WLANEvent " 11508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "from the event notification"); 11518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 11528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Reply with OK anyway to avoid getting unregistered from 11538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * events. 11548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_resp_ok(req); 11568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 11578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_process_wlanevent(ap, event); 11608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(event); 11628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_resp_ok(req); 11638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_notify(struct wps_er *er, struct http_request *req) 11678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *uri = http_request_get_uri(req); 11698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strncmp(uri, "/event/", 7) == 0) { 11718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int event_id; 11728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos; 11738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event_id = atoi(uri + 7); 11748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (event_id != er->event_id) { 11758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: HTTP event for an " 11768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "unknown event id %u", event_id); 11778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 11788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = os_strchr(uri + 7, '/'); 11808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL) 11818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 11828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos++; 11838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_event(er, req, atoi(pos)); 11848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 11858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Unknown HTTP NOTIFY for '%s'", 11868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt uri); 11878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_resp_not_found(req); 11888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_req(void *ctx, struct http_request *req) 11938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er *er = ctx; 11958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_in *cli = http_request_get_cli_addr(req); 11968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum httpread_hdr_type type = http_request_get_type(req); 11978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *buf; 11988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: HTTP request: '%s' (type %d) from " 12008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s:%d", 12018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_request_get_uri(req), type, 12028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt inet_ntoa(cli->sin_addr), ntohs(cli->sin_port)); 12038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (type) { 12058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTPREAD_HDR_TYPE_NOTIFY: 12068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_notify(er, req); 12078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 12088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 12098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Unsupported HTTP request type " 12108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%d", type); 12118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = wpabuf_alloc(200); 12128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) { 12138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_request_deinit(req); 12148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 12158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, 12178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "HTTP/1.1 501 Unimplemented\r\n" 12188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Connection: close\r\n"); 12198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_put_date(buf); 12208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_str(buf, "\r\n"); 12218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_request_send_and_deinit(req, buf); 12228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 12238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wps_er * 12288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtwps_er_init(struct wps_context *wps, const char *ifname, const char *filter) 12298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er *er; 12318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct in_addr addr; 12328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er = os_zalloc(sizeof(*er)); 12348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er == NULL) 12358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_init(&er->ap); 12378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_init(&er->ap_unsubscribing); 12388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_init(&er->ap_settings); 12398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->multicast_sd = -1; 12418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->ssdp_sd = -1; 12428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(er->ifname, ifname, sizeof(er->ifname)); 12448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->wps = wps; 12458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_get_random((unsigned char *) &er->event_id, 12468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(er->event_id)) < 0) { 12478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_deinit(er, NULL, NULL); 12488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Limit event_id to < 32 bits to avoid issues with atoi() */ 12518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->event_id &= 0x0fffffff; 12528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (filter) { 12548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (inet_aton(filter, &er->filter_addr) == 0) { 12558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "WPS UPnP: Invalid filter " 12568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "address %s", filter); 12578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_deinit(er, NULL, NULL); 12588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS UPnP: Only accepting connections " 12618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with %s", filter); 12628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (get_netif_info(ifname, &er->ip_addr, &er->ip_addr_text, 12648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->mac_addr)) { 12658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "WPS UPnP: Could not get IP/MAC address " 12668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "for %s. Does it have IP address?", ifname); 12678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_deinit(er, NULL, NULL); 12688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_er_ssdp_init(er) < 0) { 12728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "WPS UPnP: SSDP initialization failed"); 12738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_deinit(er, NULL, NULL); 12748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr.s_addr = er->ip_addr; 12788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->http_srv = http_server_init(&addr, -1, wps_er_http_req, er); 12798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er->http_srv == NULL) { 12808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "WPS UPnP: HTTP initialization failed"); 12818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_deinit(er, NULL, NULL); 12828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->http_port = http_server_get_port(er->http_srv); 12858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Start (ifname=%s ip_addr=%s)", 12878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->ifname, er->ip_addr_text); 12888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return er; 12908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wps_er_refresh(struct wps_er *er) 12948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 12968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_sta *sta; 12978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(ap, &er->ap, struct wps_er_ap, list) { 12998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_event(er->wps, ap, WPS_EV_ER_AP_ADD); 13008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(sta, &ap->sta, struct wps_er_sta, list) 13018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_sta_event(er->wps, sta, WPS_EV_ER_ENROLLEE_ADD); 13028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_send_ssdp_msearch(er); 13058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 13068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_deinit_finish(void *eloop_data, void *user_ctx) 13098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 13108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er *er = eloop_data; 13118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void (*deinit_done_cb)(void *ctx); 13128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void *deinit_done_ctx; 13138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Finishing deinit"); 13158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt deinit_done_cb = er->deinit_done_cb; 13178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt deinit_done_ctx = er->deinit_done_ctx; 13188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(er->ip_addr_text); 13198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(er); 13208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (deinit_done_cb) 13228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt deinit_done_cb(deinit_done_ctx); 13238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 13248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wps_er_deinit(struct wps_er *er, void (*cb)(void *ctx), void *ctx) 13278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 13288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er == NULL) 13298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 13308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_server_deinit(er->http_srv); 13318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_remove_all(er); 13328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ssdp_deinit(er); 13338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(dl_list_empty(&er->ap_unsubscribing) ? 0 : 5, 0, 13348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_deinit_finish, er, NULL); 13358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Finish deinit from timeout"); 13368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->deinitializing = 1; 13378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->deinit_done_cb = cb; 13388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->deinit_done_ctx = ctx; 13398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 13408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_set_sel_reg_cb(void *ctx, struct http_client *c, 13438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_client_event event) 13448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 13458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap = ctx; 13468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wps_event_data data; 13478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 13498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (event) { 13518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_OK: 13528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: SetSelectedRegistrar OK"); 13538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.set_sel_reg.state = WPS_ER_SET_SEL_REG_DONE; 13548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.set_sel_reg.uuid = ap->uuid; 13558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 13568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_FAILED: 13578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_INVALID_REPLY: 13588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_TIMEOUT: 13598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: SetSelectedRegistrar failed"); 13608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.set_sel_reg.state = WPS_ER_SET_SEL_REG_FAILED; 13618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.set_sel_reg.uuid = ap->uuid; 13628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 13638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(ap->http); 13658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = NULL; 13668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data.set_sel_reg.uuid) 13688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->er->wps->event_cb(ap->er->wps->cb_ctx, 13698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_EV_ER_SET_SELECTED_REGISTRAR, &data); 13708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 13718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_send_set_sel_reg(struct wps_er_ap *ap, struct wpabuf *msg) 13748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 13758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *buf; 13768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *len_ptr, *body_ptr; 13778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_in dst; 13788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *url, *path; 13798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->control_url == NULL) { 13818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: No controlURL for AP"); 13828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 13838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http) { 13868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Pending HTTP request for AP - " 13878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ignore new request"); 13888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 13898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->wps) { 13928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Pending WPS operation for AP - " 13938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "skip SetSelectedRegistrar"); 13948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 13958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt url = http_client_url_parse(ap->control_url, &dst, &path); 13988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (url == NULL) { 13998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to parse controlURL"); 14008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = wps_er_soap_hdr(msg, "SetSelectedRegistrar", "NewMessage", path, 14048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &dst, &len_ptr, &body_ptr); 14058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(url); 14068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 14078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_soap_end(buf, "SetSelectedRegistrar", len_ptr, body_ptr); 14108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = http_client_addr(&dst, buf, 1000, 14128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_set_sel_reg_cb, ap); 14138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http == NULL) 14148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(buf); 14158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_er_build_selected_registrar(struct wpabuf *msg, int sel_reg) 14198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, ATTR_SELECTED_REGISTRAR); 14218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, 1); 14228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(msg, !!sel_reg); 14238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 14248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_er_build_dev_password_id(struct wpabuf *msg, u16 dev_passwd_id) 14288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, ATTR_DEV_PASSWORD_ID); 14308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, 2); 14318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, dev_passwd_id); 14328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 14338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_er_build_sel_reg_config_methods(struct wpabuf *msg, 14378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 sel_reg_config_methods) 14388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, ATTR_SELECTED_REGISTRAR_CONFIG_METHODS); 14408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, 2); 14418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, sel_reg_config_methods); 14428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 14438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_er_build_uuid_r(struct wpabuf *msg, const u8 *uuid_r) 14478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS2 14498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, ATTR_UUID_R); 14508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(msg, WPS_UUID_LEN); 14518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(msg, uuid_r, WPS_UUID_LEN); 14528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS2 */ 14538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 14548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wps_er_set_sel_reg(struct wps_er *er, int sel_reg, u16 dev_passwd_id, 14588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 sel_reg_config_methods) 14598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *msg; 14618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 14628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_registrar *reg = er->wps->registrar; 14638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *auth_macs; 14648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS2 14658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 bcast[ETH_ALEN]; 14668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS2 */ 14678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t count; 14688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wps_event_data data; 14698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er->skip_set_sel_reg) { 14718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Skip SetSelectedRegistrar"); 14728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg = wpabuf_alloc(500); 14768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (msg == NULL) 14778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt auth_macs = wps_authorized_macs(reg, &count); 14808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS2 14818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (count == 0) { 14828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(bcast, 0xff, ETH_ALEN); 14838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt auth_macs = bcast; 14848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt count = 1; 14858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS2 */ 14878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_build_version(msg) || 14898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_build_selected_registrar(msg, sel_reg) || 14908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_build_dev_password_id(msg, dev_passwd_id) || 14918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_build_sel_reg_config_methods(msg, sel_reg_config_methods) || 14928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_build_wfa_ext(msg, 0, auth_macs, count) || 14938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_build_uuid_r(msg, er->wps->uuid)) { 14948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(msg); 14958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 14998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.set_sel_reg.sel_reg = sel_reg; 15008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.set_sel_reg.dev_passwd_id = dev_passwd_id; 15018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.set_sel_reg.sel_reg_config_methods = sel_reg_config_methods; 15028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.set_sel_reg.state = WPS_ER_SET_SEL_REG_START; 15038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(ap, &er->ap, struct wps_er_ap, list) { 15058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er->set_sel_reg_uuid_filter && 15068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcmp(ap->uuid, er->set_sel_reg_uuid_filter, 15078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_UUID_LEN) != 0) 15088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 15098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.set_sel_reg.uuid = ap->uuid; 15108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->wps->event_cb(er->wps->cb_ctx, 15118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_EV_ER_SET_SELECTED_REGISTRAR, &data); 15128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_send_set_sel_reg(ap, msg); 15138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(msg); 15168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wps_er_pbc(struct wps_er *er, const u8 *uuid) 15208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int res; 15228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 15238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er == NULL || er->wps == NULL) 15258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_registrar_pbc_overlap(er->wps->registrar, NULL, NULL)) { 15288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: PBC overlap - do not start PBC " 15298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "mode"); 15308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -2; 15318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap = wps_er_ap_get(er, NULL, uuid); 15348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap == NULL) { 15358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_sta *sta = NULL; 15368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(ap, &er->ap, struct wps_er_ap, list) { 15378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sta = wps_er_sta_get(ap, NULL, uuid); 15388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta) { 15398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt uuid = ap->uuid; 15408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 15418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sta == NULL) 15448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -3; /* Unknown UUID */ 15458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->ap_settings == NULL) { 15488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: AP settings not known"); 15498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -4; 15508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->set_sel_reg_uuid_filter = uuid; 15538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res = wps_registrar_button_pushed(er->wps->registrar, NULL); 15548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->set_sel_reg_uuid_filter = NULL; 15558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res) 15568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_settings_cb(void *ctx, const struct wps_credential *cred) 15638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap = ctx; 15658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wps_event_data data; 15668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: AP Settings received"); 15688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->ap_settings); 15698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->ap_settings = os_malloc(sizeof(*cred)); 15708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->ap_settings) { 15718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ap->ap_settings, cred, sizeof(*cred)); 15728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->ap_settings->cred_attr = NULL; 15738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 15768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.ap_settings.uuid = ap->uuid; 15778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.ap_settings.cred = cred; 15788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->er->wps->event_cb(ap->er->wps->cb_ctx, WPS_EV_ER_AP_SETTINGS, 15798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &data); 15808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_put_message_cb(void *ctx, struct http_client *c, 15848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_client_event event) 15858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap = ctx; 15878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *reply; 15888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *msg = NULL; 15898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (event) { 15918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_OK: 15928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: PutMessage OK"); 15938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt reply = http_client_get_body(c); 15948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (reply == NULL) 15958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 15968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg = os_zalloc(wpabuf_len(reply) + 1); 15978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (msg == NULL) 15988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 15998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(msg, wpabuf_head(reply), wpabuf_len(reply)); 16008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 16018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_FAILED: 16028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_INVALID_REPLY: 16038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_TIMEOUT: 16048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: PutMessage failed"); 16058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->wps) { 16068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_deinit(ap->wps); 16078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps = NULL; 16088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 16108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(ap->http); 16128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = NULL; 16138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (msg) { 16158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *buf; 16168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_reply_code ret; 16178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = xml_get_base64_item(msg, "NewOutMessage", &ret); 16188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(msg); 16198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) { 16208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Could not extract " 16218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "NewOutMessage from PutMessage response"); 16228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_deinit(ap->wps); 16238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps = NULL; 16248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 16258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_process(ap, buf); 16278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(buf); 16288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_put_message(struct wps_er_ap *ap, 16338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *msg) 16348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *buf; 16368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *len_ptr, *body_ptr; 16378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_in dst; 16388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *url, *path; 16398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http) { 16418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Pending HTTP operation ongoing " 16428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with the AP - cannot continue learn"); 16438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 16448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->control_url == NULL) { 16478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: No controlURL for AP"); 16488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 16498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt url = http_client_url_parse(ap->control_url, &dst, &path); 16528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (url == NULL) { 16538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to parse controlURL"); 16548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 16558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = wps_er_soap_hdr(msg, "PutMessage", "NewInMessage", path, &dst, 16588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &len_ptr, &body_ptr); 16598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(url); 16608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 16618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 16628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_soap_end(buf, "PutMessage", len_ptr, body_ptr); 16648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = http_client_addr(&dst, buf, 10000, 16668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_put_message_cb, ap); 16678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http == NULL) 16688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(buf); 16698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_process(struct wps_er_ap *ap, struct wpabuf *msg) 16738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum wps_process_res res; 16758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_parse_attr attr; 16768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum wsc_op_code op_code; 16778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op_code = WSC_MSG; 16798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_parse_msg(msg, &attr) == 0 && attr.msg_type) { 16808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (*attr.msg_type) { 16818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPS_WSC_ACK: 16828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op_code = WSC_ACK; 16838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 16848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPS_WSC_NACK: 16858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op_code = WSC_NACK; 16868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 16878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPS_WSC_DONE: 16888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op_code = WSC_Done; 16898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 16908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res = wps_process_msg(ap->wps, op_code, msg); 16948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res == WPS_CONTINUE) { 16958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *next = wps_get_msg(ap->wps, &op_code); 16968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (next) { 16978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_put_message(ap, next); 16988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(next); 16998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 17008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to build " 17018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "message"); 17028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_deinit(ap->wps); 17038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps = NULL; 17048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (res == WPS_DONE) { 17068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Protocol run done"); 17078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_deinit(ap->wps); 17088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps = NULL; 17098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 17108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to process message from " 17118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "AP (res=%d)", res); 17128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_deinit(ap->wps); 17138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps = NULL; 17148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_learn_m1(struct wps_er_ap *ap, struct wpabuf *m1) 17198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_config cfg; 17218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->wps) { 17238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Protocol run already in " 17248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "progress with this AP"); 17258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 17268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&cfg, 0, sizeof(cfg)); 17298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg.wps = ap->er->wps; 17308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg.registrar = 1; 17318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps = wps_init(&cfg); 17328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->wps == NULL) 17338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 17348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps->ap_settings_cb = wps_er_ap_settings_cb; 17358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps->ap_settings_cb_ctx = ap; 17368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_process(ap, m1); 17388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_learn(struct wps_er_ap *ap, const char *dev_info) 17428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *info; 17448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_reply_code ret; 17458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Received GetDeviceInfo response (M1) " 17478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "from the AP"); 17488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt info = xml_get_base64_item(dev_info, "NewDeviceInfo", &ret); 17498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (info == NULL) { 17508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Could not extract " 17518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "NewDeviceInfo from GetDeviceInfo response"); 17528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 17538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->m1_handler(ap, info); 17568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(info); 17578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_http_get_dev_info_cb(void *ctx, struct http_client *c, 17618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum http_client_event event) 17628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap = ctx; 17648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *reply; 17658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *dev_info = NULL; 17668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (event) { 17688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_OK: 17698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: GetDeviceInfo OK"); 17708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt reply = http_client_get_body(c); 17718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (reply == NULL) 17728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 17738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dev_info = os_zalloc(wpabuf_len(reply) + 1); 17748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dev_info == NULL) 17758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 17768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(dev_info, wpabuf_head(reply), wpabuf_len(reply)); 17778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 17788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_FAILED: 17798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_INVALID_REPLY: 17808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case HTTP_CLIENT_TIMEOUT: 17818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: GetDeviceInfo failed"); 17828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 17838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt http_client_free(ap->http); 17858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = NULL; 17868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dev_info) { 17888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_learn(ap, dev_info); 17898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(dev_info); 17908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_er_send_get_device_info(struct wps_er_ap *ap, 17958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void (*m1_handler)(struct wps_er_ap *ap, 17968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *m1)) 17978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *buf; 17998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *len_ptr, *body_ptr; 18008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_in dst; 18018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *url, *path; 18028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http) { 18048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Pending HTTP operation ongoing " 18058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with the AP - cannot get device info"); 18068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->control_url == NULL) { 18108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: No controlURL for AP"); 18118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt url = http_client_url_parse(ap->control_url, &dst, &path); 18158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (url == NULL) { 18168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Failed to parse controlURL"); 18178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = wps_er_soap_hdr(NULL, "GetDeviceInfo", NULL, path, &dst, 18218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &len_ptr, &body_ptr); 18228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(url); 18238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 18248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_soap_end(buf, "GetDeviceInfo", len_ptr, body_ptr); 18278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->http = http_client_addr(&dst, buf, 10000, 18298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_http_get_dev_info_cb, ap); 18308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->http == NULL) { 18318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(buf); 18328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->m1_handler = m1_handler; 18368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 18388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 18398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wps_er_learn(struct wps_er *er, const u8 *uuid, const u8 *pin, 18428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t pin_len) 18438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 18448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 18458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er == NULL) 18478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap = wps_er_ap_get(er, NULL, uuid); 18508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap == NULL) { 18518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: AP not found for learn " 18528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "request"); 18538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->wps) { 18568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Pending operation ongoing " 18578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with the AP - cannot start learn"); 18588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_er_send_get_device_info(ap, wps_er_ap_learn_m1) < 0) 18628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->skip_set_sel_reg = 1; 18658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_registrar_add_pin(er->wps->registrar, NULL, uuid, pin, pin_len, 0); 18668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->skip_set_sel_reg = 0; 18678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 18698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 18708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wps_er_set_config(struct wps_er *er, const u8 *uuid, 18738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wps_credential *cred) 18748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 18758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 18768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er == NULL) 18788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap = wps_er_ap_get(er, NULL, uuid); 18818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap == NULL) { 18828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: AP not found for set config " 18838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "request"); 18848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->ap_settings); 18888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->ap_settings = os_malloc(sizeof(*cred)); 18898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->ap_settings == NULL) 18908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ap->ap_settings, cred, sizeof(*cred)); 18928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->ap_settings->cred_attr = NULL; 18938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Updated local AP settings based set " 18948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "config request"); 18958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 18978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 18988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_er_ap_config_m1(struct wps_er_ap *ap, struct wpabuf *m1) 19018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 19028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_config cfg; 19038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->wps) { 19058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Protocol run already in " 19068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "progress with this AP"); 19078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 19088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&cfg, 0, sizeof(cfg)); 19118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg.wps = ap->er->wps; 19128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg.registrar = 1; 19138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg.new_ap_settings = ap->ap_settings; 19148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps = wps_init(&cfg); 19158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->wps == NULL) 19168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 19178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps->ap_settings_cb = NULL; 19188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->wps->ap_settings_cb_ctx = NULL; 19198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_er_ap_process(ap, m1); 19218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 19228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wps_er_config(struct wps_er *er, const u8 *uuid, const u8 *pin, 19258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t pin_len, const struct wps_credential *cred) 19268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 19278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_er_ap *ap; 19288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (er == NULL) 19308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 19318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap = wps_er_ap_get(er, NULL, uuid); 19338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap == NULL) { 19348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: AP not found for config " 19358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "request"); 19368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 19378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->wps) { 19398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS ER: Pending operation ongoing " 19408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with the AP - cannot start config"); 19418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 19428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(ap->ap_settings); 19458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->ap_settings = os_malloc(sizeof(*cred)); 19468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap->ap_settings == NULL) 19478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 19488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ap->ap_settings, cred, sizeof(*cred)); 19498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ap->ap_settings->cred_attr = NULL; 19508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_er_send_get_device_info(ap, wps_er_ap_config_m1) < 0) 19528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 19538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->skip_set_sel_reg = 1; 19558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_registrar_add_pin(er->wps->registrar, NULL, uuid, pin, pin_len, 0); 19568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt er->skip_set_sel_reg = 0; 19578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 19598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1960