1252190Srpaulo/* 2252190Srpaulo * Wi-Fi Direct - P2P provision discovery 3252190Srpaulo * Copyright (c) 2009-2010, Atheros Communications 4252190Srpaulo * 5252190Srpaulo * This software may be distributed under the terms of the BSD license. 6252190Srpaulo * See README for more details. 7252190Srpaulo */ 8252190Srpaulo 9252190Srpaulo#include "includes.h" 10252190Srpaulo 11252190Srpaulo#include "common.h" 12252190Srpaulo#include "common/ieee802_11_defs.h" 13252190Srpaulo#include "wps/wps_defs.h" 14252190Srpaulo#include "p2p_i.h" 15252190Srpaulo#include "p2p.h" 16252190Srpaulo 17252190Srpaulo 18252190Srpaulo/* 19252190Srpaulo * Number of retries to attempt for provision discovery requests 20252190Srpaulo * in case the peer is not listening. 21252190Srpaulo */ 22252190Srpaulo#define MAX_PROV_DISC_REQ_RETRIES 120 23252190Srpaulo 24252190Srpaulo 25252190Srpaulostatic void p2p_build_wps_ie_config_methods(struct wpabuf *buf, 26252190Srpaulo u16 config_methods) 27252190Srpaulo{ 28252190Srpaulo u8 *len; 29252190Srpaulo wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC); 30252190Srpaulo len = wpabuf_put(buf, 1); 31252190Srpaulo wpabuf_put_be32(buf, WPS_DEV_OUI_WFA); 32252190Srpaulo 33252190Srpaulo /* Config Methods */ 34252190Srpaulo wpabuf_put_be16(buf, ATTR_CONFIG_METHODS); 35252190Srpaulo wpabuf_put_be16(buf, 2); 36252190Srpaulo wpabuf_put_be16(buf, config_methods); 37252190Srpaulo 38252190Srpaulo p2p_buf_update_ie_hdr(buf, len); 39252190Srpaulo} 40252190Srpaulo 41252190Srpaulo 42252190Srpaulostatic struct wpabuf * p2p_build_prov_disc_req(struct p2p_data *p2p, 43252190Srpaulo u8 dialog_token, 44252190Srpaulo u16 config_methods, 45252190Srpaulo struct p2p_device *go) 46252190Srpaulo{ 47252190Srpaulo struct wpabuf *buf; 48252190Srpaulo u8 *len; 49252190Srpaulo size_t extra = 0; 50252190Srpaulo 51252190Srpaulo#ifdef CONFIG_WIFI_DISPLAY 52252190Srpaulo if (p2p->wfd_ie_prov_disc_req) 53252190Srpaulo extra = wpabuf_len(p2p->wfd_ie_prov_disc_req); 54252190Srpaulo#endif /* CONFIG_WIFI_DISPLAY */ 55252190Srpaulo 56252190Srpaulo buf = wpabuf_alloc(1000 + extra); 57252190Srpaulo if (buf == NULL) 58252190Srpaulo return NULL; 59252190Srpaulo 60252190Srpaulo p2p_buf_add_public_action_hdr(buf, P2P_PROV_DISC_REQ, dialog_token); 61252190Srpaulo 62252190Srpaulo len = p2p_buf_add_ie_hdr(buf); 63252190Srpaulo p2p_buf_add_capability(buf, p2p->dev_capab & 64252190Srpaulo ~P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY, 0); 65252190Srpaulo p2p_buf_add_device_info(buf, p2p, NULL); 66252190Srpaulo if (go) { 67252190Srpaulo p2p_buf_add_group_id(buf, go->info.p2p_device_addr, 68252190Srpaulo go->oper_ssid, go->oper_ssid_len); 69252190Srpaulo } 70252190Srpaulo p2p_buf_update_ie_hdr(buf, len); 71252190Srpaulo 72252190Srpaulo /* WPS IE with Config Methods attribute */ 73252190Srpaulo p2p_build_wps_ie_config_methods(buf, config_methods); 74252190Srpaulo 75252190Srpaulo#ifdef CONFIG_WIFI_DISPLAY 76252190Srpaulo if (p2p->wfd_ie_prov_disc_req) 77252190Srpaulo wpabuf_put_buf(buf, p2p->wfd_ie_prov_disc_req); 78252190Srpaulo#endif /* CONFIG_WIFI_DISPLAY */ 79252190Srpaulo 80252190Srpaulo return buf; 81252190Srpaulo} 82252190Srpaulo 83252190Srpaulo 84252190Srpaulostatic struct wpabuf * p2p_build_prov_disc_resp(struct p2p_data *p2p, 85252190Srpaulo u8 dialog_token, 86252190Srpaulo u16 config_methods, 87252190Srpaulo const u8 *group_id, 88252190Srpaulo size_t group_id_len) 89252190Srpaulo{ 90252190Srpaulo struct wpabuf *buf; 91252190Srpaulo size_t extra = 0; 92252190Srpaulo 93252190Srpaulo#ifdef CONFIG_WIFI_DISPLAY 94252190Srpaulo struct wpabuf *wfd_ie = p2p->wfd_ie_prov_disc_resp; 95252190Srpaulo if (wfd_ie && group_id) { 96252190Srpaulo size_t i; 97252190Srpaulo for (i = 0; i < p2p->num_groups; i++) { 98252190Srpaulo struct p2p_group *g = p2p->groups[i]; 99252190Srpaulo struct wpabuf *ie; 100252190Srpaulo if (!p2p_group_is_group_id_match(g, group_id, 101252190Srpaulo group_id_len)) 102252190Srpaulo continue; 103252190Srpaulo ie = p2p_group_get_wfd_ie(g); 104252190Srpaulo if (ie) { 105252190Srpaulo wfd_ie = ie; 106252190Srpaulo break; 107252190Srpaulo } 108252190Srpaulo } 109252190Srpaulo } 110252190Srpaulo if (wfd_ie) 111252190Srpaulo extra = wpabuf_len(wfd_ie); 112252190Srpaulo#endif /* CONFIG_WIFI_DISPLAY */ 113252190Srpaulo 114252190Srpaulo buf = wpabuf_alloc(100 + extra); 115252190Srpaulo if (buf == NULL) 116252190Srpaulo return NULL; 117252190Srpaulo 118252190Srpaulo p2p_buf_add_public_action_hdr(buf, P2P_PROV_DISC_RESP, dialog_token); 119252190Srpaulo 120252190Srpaulo /* WPS IE with Config Methods attribute */ 121252190Srpaulo p2p_build_wps_ie_config_methods(buf, config_methods); 122252190Srpaulo 123252190Srpaulo#ifdef CONFIG_WIFI_DISPLAY 124252190Srpaulo if (wfd_ie) 125252190Srpaulo wpabuf_put_buf(buf, wfd_ie); 126252190Srpaulo#endif /* CONFIG_WIFI_DISPLAY */ 127252190Srpaulo 128252190Srpaulo return buf; 129252190Srpaulo} 130252190Srpaulo 131252190Srpaulo 132252190Srpaulovoid p2p_process_prov_disc_req(struct p2p_data *p2p, const u8 *sa, 133252190Srpaulo const u8 *data, size_t len, int rx_freq) 134252190Srpaulo{ 135252190Srpaulo struct p2p_message msg; 136252190Srpaulo struct p2p_device *dev; 137252190Srpaulo int freq; 138252190Srpaulo int reject = 1; 139252190Srpaulo struct wpabuf *resp; 140252190Srpaulo 141252190Srpaulo if (p2p_parse(data, len, &msg)) 142252190Srpaulo return; 143252190Srpaulo 144252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 145252190Srpaulo "P2P: Received Provision Discovery Request from " MACSTR 146252190Srpaulo " with config methods 0x%x (freq=%d)", 147252190Srpaulo MAC2STR(sa), msg.wps_config_methods, rx_freq); 148252190Srpaulo 149252190Srpaulo dev = p2p_get_device(p2p, sa); 150252190Srpaulo if (dev == NULL || (dev->flags & P2P_DEV_PROBE_REQ_ONLY)) { 151252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 152252190Srpaulo "P2P: Provision Discovery Request from " 153252190Srpaulo "unknown peer " MACSTR, MAC2STR(sa)); 154252190Srpaulo 155252190Srpaulo if (p2p_add_device(p2p, sa, rx_freq, 0, 0, data + 1, len - 1, 156252190Srpaulo 0)) { 157252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 158252190Srpaulo "P2P: Provision Discovery Request add device " 159252190Srpaulo "failed " MACSTR, MAC2STR(sa)); 160252190Srpaulo } 161252190Srpaulo } else if (msg.wfd_subelems) { 162252190Srpaulo wpabuf_free(dev->info.wfd_subelems); 163252190Srpaulo dev->info.wfd_subelems = wpabuf_dup(msg.wfd_subelems); 164252190Srpaulo } 165252190Srpaulo 166252190Srpaulo if (!(msg.wps_config_methods & 167252190Srpaulo (WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD | 168252190Srpaulo WPS_CONFIG_PUSHBUTTON))) { 169252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Unsupported " 170252190Srpaulo "Config Methods in Provision Discovery Request"); 171252190Srpaulo goto out; 172252190Srpaulo } 173252190Srpaulo 174252190Srpaulo if (msg.group_id) { 175252190Srpaulo size_t i; 176252190Srpaulo for (i = 0; i < p2p->num_groups; i++) { 177252190Srpaulo if (p2p_group_is_group_id_match(p2p->groups[i], 178252190Srpaulo msg.group_id, 179252190Srpaulo msg.group_id_len)) 180252190Srpaulo break; 181252190Srpaulo } 182252190Srpaulo if (i == p2p->num_groups) { 183252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: PD " 184252190Srpaulo "request for unknown P2P Group ID - reject"); 185252190Srpaulo goto out; 186252190Srpaulo } 187252190Srpaulo } 188252190Srpaulo 189252190Srpaulo if (dev) 190252190Srpaulo dev->flags &= ~(P2P_DEV_PD_PEER_DISPLAY | 191252190Srpaulo P2P_DEV_PD_PEER_KEYPAD); 192252190Srpaulo if (msg.wps_config_methods & WPS_CONFIG_DISPLAY) { 193252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer " MACSTR 194252190Srpaulo " requested us to show a PIN on display", MAC2STR(sa)); 195252190Srpaulo if (dev) 196252190Srpaulo dev->flags |= P2P_DEV_PD_PEER_KEYPAD; 197252190Srpaulo } else if (msg.wps_config_methods & WPS_CONFIG_KEYPAD) { 198252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer " MACSTR 199252190Srpaulo " requested us to write its PIN using keypad", 200252190Srpaulo MAC2STR(sa)); 201252190Srpaulo if (dev) 202252190Srpaulo dev->flags |= P2P_DEV_PD_PEER_DISPLAY; 203252190Srpaulo } 204252190Srpaulo 205252190Srpaulo reject = 0; 206252190Srpaulo 207252190Srpauloout: 208252190Srpaulo resp = p2p_build_prov_disc_resp(p2p, msg.dialog_token, 209252190Srpaulo reject ? 0 : msg.wps_config_methods, 210252190Srpaulo msg.group_id, msg.group_id_len); 211252190Srpaulo if (resp == NULL) { 212252190Srpaulo p2p_parse_free(&msg); 213252190Srpaulo return; 214252190Srpaulo } 215252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 216252190Srpaulo "P2P: Sending Provision Discovery Response"); 217252190Srpaulo if (rx_freq > 0) 218252190Srpaulo freq = rx_freq; 219252190Srpaulo else 220252190Srpaulo freq = p2p_channel_to_freq(p2p->cfg->country, 221252190Srpaulo p2p->cfg->reg_class, 222252190Srpaulo p2p->cfg->channel); 223252190Srpaulo if (freq < 0) { 224252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 225252190Srpaulo "P2P: Unknown regulatory class/channel"); 226252190Srpaulo wpabuf_free(resp); 227252190Srpaulo p2p_parse_free(&msg); 228252190Srpaulo return; 229252190Srpaulo } 230252190Srpaulo p2p->pending_action_state = P2P_NO_PENDING_ACTION; 231252190Srpaulo if (p2p_send_action(p2p, freq, sa, p2p->cfg->dev_addr, 232252190Srpaulo p2p->cfg->dev_addr, 233252190Srpaulo wpabuf_head(resp), wpabuf_len(resp), 200) < 0) { 234252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 235252190Srpaulo "P2P: Failed to send Action frame"); 236252190Srpaulo } 237252190Srpaulo 238252190Srpaulo wpabuf_free(resp); 239252190Srpaulo 240252190Srpaulo if (!reject && p2p->cfg->prov_disc_req) { 241252190Srpaulo const u8 *dev_addr = sa; 242252190Srpaulo if (msg.p2p_device_addr) 243252190Srpaulo dev_addr = msg.p2p_device_addr; 244252190Srpaulo p2p->cfg->prov_disc_req(p2p->cfg->cb_ctx, sa, 245252190Srpaulo msg.wps_config_methods, 246252190Srpaulo dev_addr, msg.pri_dev_type, 247252190Srpaulo msg.device_name, msg.config_methods, 248252190Srpaulo msg.capability ? msg.capability[0] : 0, 249252190Srpaulo msg.capability ? msg.capability[1] : 250252190Srpaulo 0, 251252190Srpaulo msg.group_id, msg.group_id_len); 252252190Srpaulo } 253252190Srpaulo p2p_parse_free(&msg); 254252190Srpaulo} 255252190Srpaulo 256252190Srpaulo 257252190Srpaulovoid p2p_process_prov_disc_resp(struct p2p_data *p2p, const u8 *sa, 258252190Srpaulo const u8 *data, size_t len) 259252190Srpaulo{ 260252190Srpaulo struct p2p_message msg; 261252190Srpaulo struct p2p_device *dev; 262252190Srpaulo u16 report_config_methods = 0; 263252190Srpaulo int success = 0; 264252190Srpaulo 265252190Srpaulo if (p2p_parse(data, len, &msg)) 266252190Srpaulo return; 267252190Srpaulo 268252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 269252190Srpaulo "P2P: Received Provision Discovery Response from " MACSTR 270252190Srpaulo " with config methods 0x%x", 271252190Srpaulo MAC2STR(sa), msg.wps_config_methods); 272252190Srpaulo 273252190Srpaulo dev = p2p_get_device(p2p, sa); 274252190Srpaulo if (dev == NULL || !dev->req_config_methods) { 275252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 276252190Srpaulo "P2P: Ignore Provision Discovery Response from " 277252190Srpaulo MACSTR " with no pending request", MAC2STR(sa)); 278252190Srpaulo p2p_parse_free(&msg); 279252190Srpaulo return; 280252190Srpaulo } 281252190Srpaulo 282252190Srpaulo if (dev->dialog_token != msg.dialog_token) { 283252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 284252190Srpaulo "P2P: Ignore Provision Discovery Response with " 285252190Srpaulo "unexpected Dialog Token %u (expected %u)", 286252190Srpaulo msg.dialog_token, dev->dialog_token); 287252190Srpaulo p2p_parse_free(&msg); 288252190Srpaulo return; 289252190Srpaulo } 290252190Srpaulo 291252190Srpaulo if (p2p->pending_action_state == P2P_PENDING_PD) { 292252190Srpaulo os_memset(p2p->pending_pd_devaddr, 0, ETH_ALEN); 293252190Srpaulo p2p->pending_action_state = P2P_NO_PENDING_ACTION; 294252190Srpaulo } 295252190Srpaulo 296252190Srpaulo /* 297252190Srpaulo * If the response is from the peer to whom a user initiated request 298252190Srpaulo * was sent earlier, we reset that state info here. 299252190Srpaulo */ 300252190Srpaulo if (p2p->user_initiated_pd && 301252190Srpaulo os_memcmp(p2p->pending_pd_devaddr, sa, ETH_ALEN) == 0) 302252190Srpaulo p2p_reset_pending_pd(p2p); 303252190Srpaulo 304252190Srpaulo if (msg.wps_config_methods != dev->req_config_methods) { 305252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer rejected " 306252190Srpaulo "our Provision Discovery Request"); 307252190Srpaulo if (p2p->cfg->prov_disc_fail) 308252190Srpaulo p2p->cfg->prov_disc_fail(p2p->cfg->cb_ctx, sa, 309252190Srpaulo P2P_PROV_DISC_REJECTED); 310252190Srpaulo p2p_parse_free(&msg); 311252190Srpaulo goto out; 312252190Srpaulo } 313252190Srpaulo 314252190Srpaulo report_config_methods = dev->req_config_methods; 315252190Srpaulo dev->flags &= ~(P2P_DEV_PD_PEER_DISPLAY | 316252190Srpaulo P2P_DEV_PD_PEER_KEYPAD); 317252190Srpaulo if (dev->req_config_methods & WPS_CONFIG_DISPLAY) { 318252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer " MACSTR 319252190Srpaulo " accepted to show a PIN on display", MAC2STR(sa)); 320252190Srpaulo dev->flags |= P2P_DEV_PD_PEER_DISPLAY; 321252190Srpaulo } else if (msg.wps_config_methods & WPS_CONFIG_KEYPAD) { 322252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer " MACSTR 323252190Srpaulo " accepted to write our PIN using keypad", 324252190Srpaulo MAC2STR(sa)); 325252190Srpaulo dev->flags |= P2P_DEV_PD_PEER_KEYPAD; 326252190Srpaulo } 327252190Srpaulo 328252190Srpaulo /* Store the provisioning info */ 329252190Srpaulo dev->wps_prov_info = msg.wps_config_methods; 330252190Srpaulo 331252190Srpaulo p2p_parse_free(&msg); 332252190Srpaulo success = 1; 333252190Srpaulo 334252190Srpauloout: 335252190Srpaulo dev->req_config_methods = 0; 336252190Srpaulo p2p->cfg->send_action_done(p2p->cfg->cb_ctx); 337252190Srpaulo if (dev->flags & P2P_DEV_PD_BEFORE_GO_NEG) { 338252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 339252190Srpaulo "P2P: Start GO Neg after the PD-before-GO-Neg " 340252190Srpaulo "workaround with " MACSTR, 341252190Srpaulo MAC2STR(dev->info.p2p_device_addr)); 342252190Srpaulo dev->flags &= ~P2P_DEV_PD_BEFORE_GO_NEG; 343252190Srpaulo p2p_connect_send(p2p, dev); 344252190Srpaulo return; 345252190Srpaulo } 346252190Srpaulo if (success && p2p->cfg->prov_disc_resp) 347252190Srpaulo p2p->cfg->prov_disc_resp(p2p->cfg->cb_ctx, sa, 348252190Srpaulo report_config_methods); 349252190Srpaulo} 350252190Srpaulo 351252190Srpaulo 352252190Srpauloint p2p_send_prov_disc_req(struct p2p_data *p2p, struct p2p_device *dev, 353252190Srpaulo int join, int force_freq) 354252190Srpaulo{ 355252190Srpaulo struct wpabuf *req; 356252190Srpaulo int freq; 357252190Srpaulo 358252190Srpaulo if (force_freq > 0) 359252190Srpaulo freq = force_freq; 360252190Srpaulo else 361252190Srpaulo freq = dev->listen_freq > 0 ? dev->listen_freq : 362252190Srpaulo dev->oper_freq; 363252190Srpaulo if (freq <= 0) { 364252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 365252190Srpaulo "P2P: No Listen/Operating frequency known for the " 366252190Srpaulo "peer " MACSTR " to send Provision Discovery Request", 367252190Srpaulo MAC2STR(dev->info.p2p_device_addr)); 368252190Srpaulo return -1; 369252190Srpaulo } 370252190Srpaulo 371252190Srpaulo if (dev->flags & P2P_DEV_GROUP_CLIENT_ONLY) { 372252190Srpaulo if (!(dev->info.dev_capab & 373252190Srpaulo P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY)) { 374252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 375252190Srpaulo "P2P: Cannot use PD with P2P Device " MACSTR 376252190Srpaulo " that is in a group and is not discoverable", 377252190Srpaulo MAC2STR(dev->info.p2p_device_addr)); 378252190Srpaulo return -1; 379252190Srpaulo } 380252190Srpaulo /* TODO: use device discoverability request through GO */ 381252190Srpaulo } 382252190Srpaulo 383252190Srpaulo req = p2p_build_prov_disc_req(p2p, dev->dialog_token, 384252190Srpaulo dev->req_config_methods, 385252190Srpaulo join ? dev : NULL); 386252190Srpaulo if (req == NULL) 387252190Srpaulo return -1; 388252190Srpaulo 389252190Srpaulo if (p2p->state != P2P_IDLE) 390252190Srpaulo p2p_stop_listen_for_freq(p2p, freq); 391252190Srpaulo p2p->pending_action_state = P2P_PENDING_PD; 392252190Srpaulo if (p2p_send_action(p2p, freq, dev->info.p2p_device_addr, 393252190Srpaulo p2p->cfg->dev_addr, dev->info.p2p_device_addr, 394252190Srpaulo wpabuf_head(req), wpabuf_len(req), 200) < 0) { 395252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, 396252190Srpaulo "P2P: Failed to send Action frame"); 397252190Srpaulo wpabuf_free(req); 398252190Srpaulo return -1; 399252190Srpaulo } 400252190Srpaulo 401252190Srpaulo os_memcpy(p2p->pending_pd_devaddr, dev->info.p2p_device_addr, ETH_ALEN); 402252190Srpaulo 403252190Srpaulo wpabuf_free(req); 404252190Srpaulo return 0; 405252190Srpaulo} 406252190Srpaulo 407252190Srpaulo 408252190Srpauloint p2p_prov_disc_req(struct p2p_data *p2p, const u8 *peer_addr, 409252190Srpaulo u16 config_methods, int join, int force_freq, 410252190Srpaulo int user_initiated_pd) 411252190Srpaulo{ 412252190Srpaulo struct p2p_device *dev; 413252190Srpaulo 414252190Srpaulo dev = p2p_get_device(p2p, peer_addr); 415252190Srpaulo if (dev == NULL) 416252190Srpaulo dev = p2p_get_device_interface(p2p, peer_addr); 417252190Srpaulo if (dev == NULL || (dev->flags & P2P_DEV_PROBE_REQ_ONLY)) { 418252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Provision " 419252190Srpaulo "Discovery Request destination " MACSTR 420252190Srpaulo " not yet known", MAC2STR(peer_addr)); 421252190Srpaulo return -1; 422252190Srpaulo } 423252190Srpaulo 424252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Provision Discovery " 425252190Srpaulo "Request with " MACSTR " (config methods 0x%x)", 426252190Srpaulo MAC2STR(peer_addr), config_methods); 427252190Srpaulo if (config_methods == 0) 428252190Srpaulo return -1; 429252190Srpaulo 430252190Srpaulo /* Reset provisioning info */ 431252190Srpaulo dev->wps_prov_info = 0; 432252190Srpaulo 433252190Srpaulo dev->req_config_methods = config_methods; 434252190Srpaulo if (join) 435252190Srpaulo dev->flags |= P2P_DEV_PD_FOR_JOIN; 436252190Srpaulo else 437252190Srpaulo dev->flags &= ~P2P_DEV_PD_FOR_JOIN; 438252190Srpaulo 439252190Srpaulo if (p2p->state != P2P_IDLE && p2p->state != P2P_SEARCH && 440252190Srpaulo p2p->state != P2P_LISTEN_ONLY) { 441252190Srpaulo wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Busy with other " 442252190Srpaulo "operations; postpone Provision Discovery Request " 443252190Srpaulo "with " MACSTR " (config methods 0x%x)", 444252190Srpaulo MAC2STR(peer_addr), config_methods); 445252190Srpaulo return 0; 446252190Srpaulo } 447252190Srpaulo 448252190Srpaulo p2p->user_initiated_pd = user_initiated_pd; 449252190Srpaulo 450252190Srpaulo if (p2p->user_initiated_pd) 451252190Srpaulo p2p->pd_retries = MAX_PROV_DISC_REQ_RETRIES; 452252190Srpaulo 453252190Srpaulo /* 454252190Srpaulo * Assign dialog token here to use the same value in each retry within 455252190Srpaulo * the same PD exchange. 456252190Srpaulo */ 457252190Srpaulo dev->dialog_token++; 458252190Srpaulo if (dev->dialog_token == 0) 459252190Srpaulo dev->dialog_token = 1; 460252190Srpaulo 461252190Srpaulo return p2p_send_prov_disc_req(p2p, dev, join, force_freq); 462252190Srpaulo} 463252190Srpaulo 464252190Srpaulo 465252190Srpaulovoid p2p_reset_pending_pd(struct p2p_data *p2p) 466252190Srpaulo{ 467252190Srpaulo struct p2p_device *dev; 468252190Srpaulo 469252190Srpaulo dl_list_for_each(dev, &p2p->devices, struct p2p_device, list) { 470252190Srpaulo if (os_memcmp(p2p->pending_pd_devaddr, 471252190Srpaulo dev->info.p2p_device_addr, ETH_ALEN)) 472252190Srpaulo continue; 473252190Srpaulo if (!dev->req_config_methods) 474252190Srpaulo continue; 475252190Srpaulo if (dev->flags & P2P_DEV_PD_FOR_JOIN) 476252190Srpaulo continue; 477252190Srpaulo /* Reset the config methods of the device */ 478252190Srpaulo dev->req_config_methods = 0; 479252190Srpaulo } 480252190Srpaulo 481252190Srpaulo p2p->user_initiated_pd = 0; 482252190Srpaulo os_memset(p2p->pending_pd_devaddr, 0, ETH_ALEN); 483252190Srpaulo p2p->pd_retries = 0; 484252190Srpaulo} 485