18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * P2P - IE builder 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2009-2010, Atheros Communications 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 "common/ieee802_11_defs.h" 13d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#include "common/qca-vendor.h" 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps/wps_i.h" 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "p2p_i.h" 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_action_hdr(struct wpabuf *buf, u8 subtype, u8 dialog_token) 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_ACTION_VENDOR_SPECIFIC); 21a38abf9af7bec7e89dbfb39ac7bb77223fe47c72Dmitry Shmidt wpabuf_put_be32(buf, P2P_IE_VENDOR_TYPE); 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, subtype); /* OUI Subtype */ 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, dialog_token); 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Dialog Token: %d", dialog_token); 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_public_action_hdr(struct wpabuf *buf, u8 subtype, 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dialog_token) 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_ACTION_PUBLIC); 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_PA_VENDOR_SPECIFIC); 34a38abf9af7bec7e89dbfb39ac7bb77223fe47c72Dmitry Shmidt wpabuf_put_be32(buf, P2P_IE_VENDOR_TYPE); 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, subtype); /* OUI Subtype */ 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, dialog_token); 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Dialog Token: %d", dialog_token); 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtu8 * p2p_buf_add_ie_hdr(struct wpabuf *buf) 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P IE header */ 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC); 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 1); /* IE length to be filled */ 49a38abf9af7bec7e89dbfb39ac7bb77223fe47c72Dmitry Shmidt wpabuf_put_be32(buf, P2P_IE_VENDOR_TYPE); 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P IE header"); 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return len; 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_update_ie_hdr(struct wpabuf *buf, u8 *len) 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update P2P IE Length */ 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *len = (u8 *) wpabuf_put(buf, 0) - len - 1; 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_capability(struct wpabuf *buf, u8 dev_capab, u8 group_capab) 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Capability */ 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CAPABILITY); 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 2); 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, dev_capab); /* Device Capabilities */ 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, group_capab); /* Group Capabilities */ 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Capability dev=%02x group=%02x", 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dev_capab, group_capab); 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_go_intent(struct wpabuf *buf, u8 go_intent) 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Group Owner Intent */ 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_GROUP_OWNER_INTENT); 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 1); 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, go_intent); 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * GO Intent: Intent %u Tie breaker %u", 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt go_intent >> 1, go_intent & 0x01); 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_listen_channel(struct wpabuf *buf, const char *country, 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 reg_class, u8 channel) 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Listen Channel */ 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_LISTEN_CHANNEL); 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 5); 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, country, 3); 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, reg_class); /* Regulatory Class */ 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, channel); /* Channel Number */ 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Listen Channel: Regulatory Class %u " 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Channel %u", reg_class, channel); 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_operating_channel(struct wpabuf *buf, const char *country, 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 reg_class, u8 channel) 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Operating Channel */ 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_OPERATING_CHANNEL); 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 5); 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, country, 3); 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, reg_class); /* Regulatory Class */ 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, channel); /* Channel Number */ 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Operating Channel: Regulatory Class %u " 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Channel %u", reg_class, channel); 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 113d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidtvoid p2p_buf_add_pref_channel_list(struct wpabuf *buf, 114d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt const u32 *preferred_freq_list, 115d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt unsigned int size) 116d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt{ 117d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt unsigned int i, count = 0; 118d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt u8 op_class, op_channel; 119d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt 120d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (!size) 121d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt return; 122d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt 123d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt /* 124d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt * First, determine the number of P2P supported channels in the 125d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt * pref_freq_list returned from driver. This is needed for calculations 126d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt * of the vendor IE size. 127d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt */ 128d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt for (i = 0; i < size; i++) { 129d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (p2p_freq_to_channel(preferred_freq_list[i], &op_class, 130d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt &op_channel) == 0) 131d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt count++; 132d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt } 133d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt 134d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC); 135d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpabuf_put_u8(buf, 4 + count * sizeof(u16)); 136d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpabuf_put_be24(buf, OUI_QCA); 137d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpabuf_put_u8(buf, QCA_VENDOR_ELEM_P2P_PREF_CHAN_LIST); 138d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt for (i = 0; i < size; i++) { 139d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (p2p_freq_to_channel(preferred_freq_list[i], &op_class, 140d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt &op_channel) < 0) { 141d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpa_printf(MSG_DEBUG, "Unsupported frequency %u MHz", 142d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt preferred_freq_list[i]); 143d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt continue; 144d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt } 145d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpabuf_put_u8(buf, op_class); 146d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpabuf_put_u8(buf, op_channel); 147d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt } 148d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt} 149d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt 150d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_channel_list(struct wpabuf *buf, const char *country, 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_channels *chan) 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i; 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Channel List */ 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CHANNEL_LIST); 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 2); /* IE length to be filled */ 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, country, 3); /* Country String */ 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < chan->reg_classes; i++) { 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_reg_class *c = &chan->reg_class[i]; 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, c->reg_class); 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, c->channels); 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, c->channel, c->channels); 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update attribute length */ 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(len, (u8 *) wpabuf_put(buf, 0) - len - 2); 17191c40cdce17424d9a4718876becf0b7811cf68f2Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "P2P: * Channel List", 17291c40cdce17424d9a4718876becf0b7811cf68f2Dmitry Shmidt len + 2, (u8 *) wpabuf_put(buf, 0) - len - 2); 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 175d5e4923d04122f81300fa68fb07d64ede28fd44dDmitry Shmidt 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_status(struct wpabuf *buf, u8 status) 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Status */ 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_STATUS); 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 1); 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, status); 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Status: %d", status); 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_device_info(struct wpabuf *buf, struct p2p_data *p2p, 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_device *peer) 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 methods; 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t nlen, i; 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device Info */ 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_DEVICE_INFO); 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 2); /* IE length to be filled */ 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device address */ 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN); 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Config Methods */ 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods = 0; 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer && peer->wps_method != WPS_NOT_READY) { 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->wps_method == WPS_PBC) 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_PUSHBUTTON; 205849734c8d1847920ed7042463f7480b1e0c1dfeaDmitry Shmidt else if (peer->wps_method == WPS_P2PS) 206849734c8d1847920ed7042463f7480b1e0c1dfeaDmitry Shmidt methods |= WPS_CONFIG_P2PS; 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (peer->wps_method == WPS_PIN_DISPLAY || 208849734c8d1847920ed7042463f7480b1e0c1dfeaDmitry Shmidt peer->wps_method == WPS_PIN_KEYPAD) 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD; 2101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } else if (p2p->cfg->config_methods) { 2111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt methods |= p2p->cfg->config_methods & 2121f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt (WPS_CONFIG_PUSHBUTTON | WPS_CONFIG_DISPLAY | 213aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt WPS_CONFIG_KEYPAD | WPS_CONFIG_P2PS); 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_PUSHBUTTON; 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD; 217aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt methods |= WPS_CONFIG_P2PS; 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, methods); 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Primary Device Type */ 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->pri_dev_type, 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(p2p->cfg->pri_dev_type)); 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Number of Secondary Device Types */ 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, p2p->cfg->num_sec_dev_types); 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Secondary Device Type List */ 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < p2p->cfg->num_sec_dev_types; i++) 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->sec_dev_type[i], 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_DEV_TYPE_LEN); 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Device Name */ 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt nlen = p2p->cfg->dev_name ? os_strlen(p2p->cfg->dev_name) : 0; 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_DEV_NAME); 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, nlen); 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_name, nlen); 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update attribute length */ 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(len, (u8 *) wpabuf_put(buf, 0) - len - 2); 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Device Info"); 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_device_id(struct wpabuf *buf, const u8 *dev_addr) 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device ID */ 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_DEVICE_ID); 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN); 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, dev_addr, ETH_ALEN); 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Device ID: " MACSTR, MAC2STR(dev_addr)); 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_config_timeout(struct wpabuf *buf, u8 go_timeout, 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 client_timeout) 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Configuration Timeout */ 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CONFIGURATION_TIMEOUT); 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 2); 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, go_timeout); 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, client_timeout); 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Configuration Timeout: GO %d (*10ms) " 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "client %d (*10ms)", go_timeout, client_timeout); 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_intended_addr(struct wpabuf *buf, const u8 *interface_addr) 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Intended P2P Interface Address */ 2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_INTENDED_INTERFACE_ADDR); 2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN); 2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, interface_addr, ETH_ALEN); 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Intended P2P Interface Address " MACSTR, 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(interface_addr)); 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_group_bssid(struct wpabuf *buf, const u8 *bssid) 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Group BSSID */ 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_GROUP_BSSID); 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN); 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, bssid, ETH_ALEN); 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P Group BSSID " MACSTR, 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(bssid)); 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_group_id(struct wpabuf *buf, const u8 *dev_addr, 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *ssid, size_t ssid_len) 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Group ID */ 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_GROUP_ID); 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN + ssid_len); 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, dev_addr, ETH_ALEN); 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, ssid, ssid_len); 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P Group ID " MACSTR, 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(dev_addr)); 3005460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "P2P: P2P Group ID SSID", ssid, ssid_len); 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_invitation_flags(struct wpabuf *buf, u8 flags) 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Invitation Flags */ 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_INVITATION_FLAGS); 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 1); 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, flags); 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Invitation Flags: bitmap 0x%x", flags); 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void p2p_buf_add_noa_desc(struct wpabuf *buf, struct p2p_noa_desc *desc) 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (desc == NULL) 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, desc->count_type); 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le32(buf, desc->duration); 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le32(buf, desc->interval); 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le32(buf, desc->start_time); 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_noa(struct wpabuf *buf, u8 noa_index, u8 opp_ps, u8 ctwindow, 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_noa_desc *desc1, struct p2p_noa_desc *desc2) 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Notice of Absence */ 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_NOTICE_OF_ABSENCE); 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 2 + (desc1 ? 13 : 0) + (desc2 ? 13 : 0)); 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, noa_index); 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, (opp_ps ? 0x80 : 0) | (ctwindow & 0x7f)); 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_buf_add_noa_desc(buf, desc1); 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_buf_add_noa_desc(buf, desc2); 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Notice of Absence"); 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_ext_listen_timing(struct wpabuf *buf, u16 period, 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 interval) 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Extended Listen Timing */ 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_EXT_LISTEN_TIMING); 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 4); 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, period); 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, interval); 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Extended Listen Timing (period %u msec " 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "interval %u msec)", period, interval); 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_p2p_interface(struct wpabuf *buf, struct p2p_data *p2p) 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Interface */ 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_INTERFACE); 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN + 1 + ETH_ALEN); 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device address */ 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN); 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * FIX: Fetch interface address list from driver. Do not include 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the P2P Device address if it is never used as interface address. 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Interface Address Count */ 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, 1); 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN); 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 370cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidtvoid p2p_buf_add_oob_go_neg_channel(struct wpabuf *buf, const char *country, 371cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt u8 oper_class, u8 channel, 372cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt enum p2p_role_indication role) 373cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt{ 374cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt /* OOB Group Owner Negotiation Channel */ 375cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_OOB_GO_NEG_CHANNEL); 376cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_le16(buf, 6); 377cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_data(buf, country, 3); 378cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_u8(buf, oper_class); /* Operating Class */ 379cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_u8(buf, channel); /* Channel Number */ 380cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_u8(buf, (u8) role); /* Role indication */ 381cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * OOB GO Negotiation Channel: Operating " 382cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt "Class %u Channel %u Role %d", 383cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt oper_class, channel, role); 384cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt} 385cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt 386cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt 387aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_service_hash(struct wpabuf *buf, struct p2p_data *p2p) 388aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 389aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!p2p) 390aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 391aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 392aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Service Hash */ 393aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_SERVICE_HASH); 394aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, p2p->p2ps_seek_count * P2PS_HASH_LEN); 395a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_data(buf, p2p->p2ps_seek_hash, 396aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt p2p->p2ps_seek_count * P2PS_HASH_LEN); 397aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "P2P: * Service Hash", 398a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p->p2ps_seek_hash, p2p->p2ps_seek_count * P2PS_HASH_LEN); 399aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 400aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 401aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 402aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_session_info(struct wpabuf *buf, const char *info) 403aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 404aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt size_t info_len = 0; 405aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 406aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (info && info[0]) 407aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt info_len = os_strlen(info); 408aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 409aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Session Information Data Info */ 410aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_SESSION_INFORMATION_DATA); 411aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, (u16) info_len); 412aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 413aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (info) { 414aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, info, info_len); 415aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Session Info Data (%s)", info); 416aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 417aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 418aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 419aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 420aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_connection_capability(struct wpabuf *buf, u8 connection_cap) 421aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 422aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Connection Capability Info */ 423aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CONNECTION_CAPABILITY); 424aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, 1); 425aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, connection_cap); 426aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Connection Capability: 0x%x", 427aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt connection_cap); 428aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 429aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 430aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 431aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_advertisement_id(struct wpabuf *buf, u32 id, const u8 *mac) 432aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 433aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!buf || !mac) 434aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 435aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 436aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Advertisement ID Info */ 437aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_ADVERTISEMENT_ID); 438aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, (u16) (sizeof(u32) + ETH_ALEN)); 439aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le32(buf, id); 440aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, mac, ETH_ALEN); 441aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Advertisement ID (%x) " MACSTR, 442aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt id, MAC2STR(mac)); 443aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 444aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 445aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 446a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidtstatic int p2ps_wildcard_hash(struct p2p_data *p2p, 447a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt const u8 *hash, u8 hash_count) 448a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt{ 449a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt u8 i; 450a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt const u8 *test = hash; 451a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 452a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt for (i = 0; i < hash_count; i++) { 453a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (os_memcmp(test, p2p->wild_card_hash, P2PS_HASH_LEN) == 0) 454a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return 1; 455a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt test += P2PS_HASH_LEN; 456a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } 457a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 458a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return 0; 459a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt} 460a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 461a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 462a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidtstatic int p2p_wfa_service_adv(struct p2p_data *p2p) 463aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 464aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt struct p2ps_advertisement *adv; 465aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 466a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt for (adv = p2p->p2ps_adv_list; adv; adv = adv->next) { 467a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (os_strncmp(adv->svc_name, P2PS_WILD_HASH_STR, 468a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt os_strlen(P2PS_WILD_HASH_STR)) == 0) 469a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return 1; 470a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } 471aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 472a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return 0; 473a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt} 474aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 475aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 476a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidtstatic int p2p_buf_add_service_info(struct wpabuf *buf, struct p2p_data *p2p, 477a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt u32 adv_id, u16 config_methods, 478a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt const char *svc_name, u8 **ie_len, u8 **pos, 479a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt size_t *total_len, u8 *attr_len) 480a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt{ 481a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt size_t svc_len; 482a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt size_t remaining; 483a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt size_t info_len; 484a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 485a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_dbg(p2p, "Add service info for %s (adv_id=%u)", svc_name, adv_id); 486a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt svc_len = os_strlen(svc_name); 487a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt info_len = sizeof(adv_id) + sizeof(config_methods) + sizeof(u8) + 488a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt svc_len; 489a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 490a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (info_len + *total_len > MAX_SVC_ADV_LEN) { 491a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_dbg(p2p, 492a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt "Unsufficient buffer, failed to add advertised service info"); 493a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return -1; 494a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } 495aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 496a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (svc_len > 255) { 497a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_dbg(p2p, 498a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt "Invalid service name length (%u bytes), failed to add advertised service info", 499a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt (unsigned int) svc_len); 500a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return -1; 501a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } 502aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 503a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (*ie_len) { 504a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt int ie_data_len = (*pos - *ie_len) - 1; 505aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 506a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (ie_data_len < 0 || ie_data_len > 255) { 507a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_dbg(p2p, 508a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt "Invalid IE length, failed to add advertised service info"); 509a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return -1; 510aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 511a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt remaining = 255 - ie_data_len; 512a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } else { 513a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* 514a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt * Adding new P2P IE header takes 6 extra bytes: 515a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt * - 2 byte IE header (1 byte IE id and 1 byte length) 516a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt * - 4 bytes of IE_VENDOR_TYPE are reduced from 255 below 517a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt */ 518a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt *ie_len = p2p_buf_add_ie_hdr(buf); 519a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt remaining = 255 - 4; 520a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } 521aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 522a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (remaining < sizeof(u32) + sizeof(u16) + sizeof(u8)) { 523a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* 524a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt * Split adv_id, config_methods, and svc_name_len between two 525a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt * IEs. 526a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt */ 527a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt size_t front = remaining; 528a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt size_t back = sizeof(u32) + sizeof(u16) + sizeof(u8) - front; 529a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt u8 holder[sizeof(u32) + sizeof(u16) + sizeof(u8)]; 530aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 531a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt WPA_PUT_LE32(holder, adv_id); 532a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt WPA_PUT_BE16(&holder[sizeof(u32)], config_methods); 533a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt holder[sizeof(u32) + sizeof(u16)] = svc_len; 534aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 535a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (front) 536a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_data(buf, holder, front); 537aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 538a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_buf_update_ie_hdr(buf, *ie_len); 539a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt *ie_len = p2p_buf_add_ie_hdr(buf); 540aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 541a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_data(buf, &holder[front], back); 542a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt remaining = 255 - 4 - (sizeof(u32) + sizeof(u16) + sizeof(u8)) - 543a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt back; 544a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } else { 545a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_le32(buf, adv_id); 546a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_be16(buf, config_methods); 547a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_u8(buf, svc_len); 548a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt remaining -= sizeof(adv_id) + sizeof(config_methods) + 549a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt sizeof(u8); 550aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 551aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 552a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (remaining < svc_len) { 553a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* split svc_name between two or three IEs */ 554a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt size_t front = remaining; 555a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt size_t back = svc_len - front; 556aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 557a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (front) 558a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_data(buf, svc_name, front); 559aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 560a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_buf_update_ie_hdr(buf, *ie_len); 561a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt *ie_len = p2p_buf_add_ie_hdr(buf); 562a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 563a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* In rare cases, we must split across 3 attributes */ 564a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (back > 255 - 4) { 565a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_data(buf, &svc_name[front], 255 - 4); 566a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt back -= 255 - 4; 567a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt front += 255 - 4; 568a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_buf_update_ie_hdr(buf, *ie_len); 569a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt *ie_len = p2p_buf_add_ie_hdr(buf); 570a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } 571a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 572a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_data(buf, &svc_name[front], back); 573a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt remaining = 255 - 4 - back; 574aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } else { 575a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_data(buf, svc_name, svc_len); 576a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt remaining -= svc_len; 577aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 578aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 579a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_buf_update_ie_hdr(buf, *ie_len); 580a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 581a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* set *ie_len to NULL if a new IE has to be added on the next call */ 582a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (!remaining) 583a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt *ie_len = NULL; 584a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 585a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* set *pos to point to the next byte to update */ 586a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt *pos = wpabuf_put(buf, 0); 587a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 588a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt *total_len += info_len; 589a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt WPA_PUT_LE16(attr_len, (u16) *total_len); 590a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return 0; 591a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt} 592a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 593a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 594a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidtvoid p2p_buf_add_service_instance(struct wpabuf *buf, struct p2p_data *p2p, 595a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt u8 hash_count, const u8 *hash, 596a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt struct p2ps_advertisement *adv_list) 597a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt{ 598a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt struct p2ps_advertisement *adv; 5994171258d30a612645aa061cede62233b5c58ca2aDmitry Shmidt int p2ps_wildcard; 600a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt size_t total_len; 601a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt struct wpabuf *tmp_buf = NULL; 602a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt u8 *pos, *attr_len, *ie_len = NULL; 603a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 604a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (!adv_list || !hash || !hash_count) 605a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return; 606a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 607a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "P2PS: Probe Request service hash values", 608a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt hash, hash_count * P2PS_HASH_LEN); 609a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2ps_wildcard = p2ps_wildcard_hash(p2p, hash, hash_count) && 610a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_wfa_service_adv(p2p); 611a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 612a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* Allocate temp buffer, allowing for overflow of 1 instance */ 613a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt tmp_buf = wpabuf_alloc(MAX_SVC_ADV_IE_LEN + 256 + P2PS_HASH_LEN); 614a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (!tmp_buf) 615a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt return; 616a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 617a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* 618a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt * Attribute data can be split into a number of IEs. Start with the 619a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt * first IE and the attribute headers here. 620a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt */ 621a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt ie_len = p2p_buf_add_ie_hdr(tmp_buf); 622a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 623a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt total_len = 0; 624a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 625a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_u8(tmp_buf, P2P_ATTR_ADVERTISED_SERVICE); 626a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt attr_len = wpabuf_put(tmp_buf, sizeof(u16)); 627a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt WPA_PUT_LE16(attr_len, (u16) total_len); 628a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_buf_update_ie_hdr(tmp_buf, ie_len); 629a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt pos = wpabuf_put(tmp_buf, 0); 630a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 631a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (p2ps_wildcard) { 632a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* org.wi-fi.wfds match found */ 633a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_buf_add_service_info(tmp_buf, p2p, 0, 0, P2PS_WILD_HASH_STR, 634a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt &ie_len, &pos, &total_len, attr_len); 635a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } 636a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 637a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* add advertised service info of matching services */ 638a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt for (adv = adv_list; adv && total_len <= MAX_SVC_ADV_LEN; 639a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt adv = adv->next) { 640a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt const u8 *test = hash; 641a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt u8 i; 642a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 643a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt for (i = 0; i < hash_count; i++) { 644a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt /* exact name hash match */ 645a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt if (os_memcmp(test, adv->hash, P2PS_HASH_LEN) == 0 && 646a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt p2p_buf_add_service_info(tmp_buf, p2p, 647a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt adv->id, 648a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt adv->config_methods, 649a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt adv->svc_name, 650a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt &ie_len, &pos, 651a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt &total_len, 652a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt attr_len)) 653a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt break; 6544171258d30a612645aa061cede62233b5c58ca2aDmitry Shmidt 655a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt test += P2PS_HASH_LEN; 656a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } 657a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt } 658a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt 6594171258d30a612645aa061cede62233b5c58ca2aDmitry Shmidt if (total_len) 660a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt wpabuf_put_buf(buf, tmp_buf); 661aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_free(tmp_buf); 662aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 663aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 664aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 665aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_session_id(struct wpabuf *buf, u32 id, const u8 *mac) 666aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 667aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!buf || !mac) 668aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 669aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 670aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Session ID Info */ 671aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_SESSION_ID); 672aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, (u16) (sizeof(u32) + ETH_ALEN)); 673aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le32(buf, id); 674aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, mac, ETH_ALEN); 675aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Session ID Info (%x) " MACSTR, 676aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt id, MAC2STR(mac)); 677aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 678aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 679aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 680aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_feature_capability(struct wpabuf *buf, u16 len, const u8 *mask) 681aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 682aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!buf || !len || !mask) 683aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 684aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 685aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Feature Capability */ 686aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_FEATURE_CAPABILITY); 687aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, len); 688aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, mask, len); 689aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Feature Capability (%d)", len); 690aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 691aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 692aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 693aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_persistent_group_info(struct wpabuf *buf, const u8 *dev_addr, 694aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt const u8 *ssid, size_t ssid_len) 695aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 696aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* P2P Group ID */ 697aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_PERSISTENT_GROUP); 698aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN + ssid_len); 699aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, dev_addr, ETH_ALEN); 700aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, ssid, ssid_len); 701aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P Group ID " MACSTR, 702aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt MAC2STR(dev_addr)); 703aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 704aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 705aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 70668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidtstatic int p2p_add_wps_string(struct wpabuf *buf, enum wps_attribute attr, 70768d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt const char *val) 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 7108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = val ? os_strlen(val) : 0; 71268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 4 + len) 71368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 71468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt wpabuf_put_be16(buf, attr); 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef CONFIG_WPS_STRICT 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len == 0) { 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 7188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Some deployed WPS implementations fail to parse zeor-length 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * attributes. As a workaround, send a space character if the 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * device attribute string is empty. 7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 72268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 3) 72368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 1); 7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, ' '); 72668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return 0; 7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_STRICT */ 7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, len); 7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (val) 7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, val, len); 73268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return 0; 7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 73668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidtint p2p_build_wps_ie(struct p2p_data *p2p, struct wpabuf *buf, int pw_id, 73768d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt int all_attr) 7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 7418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 74268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 6) 74368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 7448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC); 7458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 1); 7468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be32(buf, WPS_DEV_OUI_WFA); 7478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 74868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wps_build_version(buf) < 0) 74968d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 7508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (all_attr) { 75268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 5) 75368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 7548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_WPS_STATE); 7558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 1); 7568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WPS_STATE_NOT_CONFIGURED); 7578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 75904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (pw_id >= 0) { 76068d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 6) 76168d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 76204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Device Password ID */ 76304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpabuf_put_be16(buf, ATTR_DEV_PASSWORD_ID); 76404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpabuf_put_be16(buf, 2); 76504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: WPS IE Device Password ID: %d", 76604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt pw_id); 76704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpabuf_put_be16(buf, pw_id); 76804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 7698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (all_attr) { 77168d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 5) 77268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 7738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_RESPONSE_TYPE); 7748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 1); 7758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WPS_RESP_ENROLLEE_INFO); 7768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 77768d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wps_build_uuid_e(buf, p2p->cfg->uuid) < 0 || 77868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p_add_wps_string(buf, ATTR_MANUFACTURER, 77968d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p->cfg->manufacturer) < 0 || 78068d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p_add_wps_string(buf, ATTR_MODEL_NAME, 78168d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p->cfg->model_name) < 0 || 78268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p_add_wps_string(buf, ATTR_MODEL_NUMBER, 78368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p->cfg->model_number) < 0 || 78468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p_add_wps_string(buf, ATTR_SERIAL_NUMBER, 78568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p->cfg->serial_number) < 0) 78668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 78768d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt 78868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 4 + WPS_DEV_TYPE_LEN) 78968d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 7908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_PRIMARY_DEV_TYPE); 7918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, WPS_DEV_TYPE_LEN); 7928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->pri_dev_type, WPS_DEV_TYPE_LEN); 7938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 79468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (p2p_add_wps_string(buf, ATTR_DEV_NAME, p2p->cfg->dev_name) 79568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt < 0) 79668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 7978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 79868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 6) 79968d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 8008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_CONFIG_METHODS); 8018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 2); 8028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, p2p->cfg->config_methods); 8038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 80568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wps_build_wfa_ext(buf, 0, NULL, 0) < 0) 80668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 8078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (all_attr && p2p->cfg->num_sec_dev_types) { 80968d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 81068d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt 4 + WPS_DEV_TYPE_LEN * p2p->cfg->num_sec_dev_types) 81168d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 8128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_SECONDARY_DEV_TYPE_LIST); 8138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, WPS_DEV_TYPE_LEN * 8148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p->cfg->num_sec_dev_types); 8158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->sec_dev_type, 8168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_DEV_TYPE_LEN * 8178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p->cfg->num_sec_dev_types); 8188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Add the WPS vendor extensions */ 8218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < P2P_MAX_WPS_VENDOR_EXT; i++) { 8228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (p2p->wps_vendor_ext[i] == NULL) 8238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 8248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpabuf_tailroom(buf) < 8258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4 + wpabuf_len(p2p->wps_vendor_ext[i])) 8268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 8278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_VENDOR_EXT); 8288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, wpabuf_len(p2p->wps_vendor_ext[i])); 8298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_buf(buf, p2p->wps_vendor_ext[i]); 8308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_buf_update_ie_hdr(buf, len); 83368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt 83468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return 0; 8358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 836