18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Wi-Fi Protected Setup - UPnP AP functionality 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2009, 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 "eloop.h" 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "uuid.h" 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps_i.h" 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps_upnp.h" 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps_upnp_i.h" 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void upnp_er_set_selected_timeout(void *eloop_ctx, void *timeout_ctx) 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct subscription *s = eloop_ctx; 22c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt struct wps_registrar *reg = timeout_ctx; 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS: SetSelectedRegistrar from ER timed out"); 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt s->selected_registrar = 0; 254b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt wps_registrar_selected_registrar_changed(reg, 0); 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint upnp_er_set_selected_registrar(struct wps_registrar *reg, 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct subscription *s, 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *msg) 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wps_parse_attr attr; 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_buf(MSG_MSGDUMP, "WPS: SetSelectedRegistrar attributes", 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg); 37d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (wps_validate_upnp_set_selected_registrar(msg) < 0 || 38d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wps_parse_msg(msg, &attr) < 0) 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt s->reg = reg; 42c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt eloop_cancel_timeout(upnp_er_set_selected_timeout, s, reg); 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(s->authorized_macs, 0, sizeof(s->authorized_macs)); 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr.selected_registrar == NULL || *attr.selected_registrar == 0) { 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS: SetSelectedRegistrar: Disable " 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Selected Registrar"); 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt s->selected_registrar = 0; 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt s->selected_registrar = 1; 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt s->dev_password_id = attr.dev_password_id ? 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_GET_BE16(attr.dev_password_id) : DEV_PW_DEFAULT; 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt s->config_methods = attr.sel_reg_config_methods ? 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_GET_BE16(attr.sel_reg_config_methods) : -1; 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr.authorized_macs) { 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int count = attr.authorized_macs_len / ETH_ALEN; 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (count > WPS_MAX_AUTHORIZED_MACS) 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt count = WPS_MAX_AUTHORIZED_MACS; 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(s->authorized_macs, attr.authorized_macs, 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt count * ETH_ALEN); 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (!attr.version2) { 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "WPS: Add broadcast " 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "AuthorizedMACs for WPS 1.0 ER"); 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(s->authorized_macs, 0xff, ETH_ALEN); 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(WPS_PBC_WALK_TIME, 0, 67c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt upnp_er_set_selected_timeout, s, reg); 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 704b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt wps_registrar_selected_registrar_changed(reg, 0); 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 76c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidtvoid upnp_er_remove_notification(struct wps_registrar *reg, 77c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt struct subscription *s) 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt s->selected_registrar = 0; 80c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt eloop_cancel_timeout(upnp_er_set_selected_timeout, s, reg); 81c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt if (reg) 824b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt wps_registrar_selected_registrar_changed(reg, 0); 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 84