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