p2p_build.c revision 1f69aa52ea2e0a73ac502565df8c666ee49cab6a
18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * P2P - IE builder 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2009-2010, Atheros Communications 48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 58d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This program is free software; you can redistribute it and/or modify 68d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * it under the terms of the GNU General Public License version 2 as 78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * published by the Free Software Foundation. 88d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 98d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Alternatively, this software may be distributed under the terms of BSD 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * license. 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * See README and COPYING for more details. 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "includes.h" 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common.h" 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common/ieee802_11_defs.h" 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps/wps_i.h" 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "p2p_i.h" 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_action_hdr(struct wpabuf *buf, u8 subtype, u8 dialog_token) 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_ACTION_VENDOR_SPECIFIC); 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be24(buf, OUI_WFA); 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_OUI_TYPE); 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, subtype); /* OUI Subtype */ 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, dialog_token); 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Dialog Token: %d", dialog_token); 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_public_action_hdr(struct wpabuf *buf, u8 subtype, 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dialog_token) 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_ACTION_PUBLIC); 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_PA_VENDOR_SPECIFIC); 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be24(buf, OUI_WFA); 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_OUI_TYPE); 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, subtype); /* OUI Subtype */ 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, dialog_token); 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Dialog Token: %d", dialog_token); 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtu8 * p2p_buf_add_ie_hdr(struct wpabuf *buf) 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P IE header */ 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC); 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 1); /* IE length to be filled */ 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be24(buf, OUI_WFA); 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_OUI_TYPE); 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P IE header"); 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return len; 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_update_ie_hdr(struct wpabuf *buf, u8 *len) 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update P2P IE Length */ 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *len = (u8 *) wpabuf_put(buf, 0) - len - 1; 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_capability(struct wpabuf *buf, u8 dev_capab, u8 group_capab) 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Capability */ 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CAPABILITY); 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 2); 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, dev_capab); /* Device Capabilities */ 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, group_capab); /* Group Capabilities */ 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Capability dev=%02x group=%02x", 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dev_capab, group_capab); 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_go_intent(struct wpabuf *buf, u8 go_intent) 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Group Owner Intent */ 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_GROUP_OWNER_INTENT); 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 1); 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, go_intent); 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * GO Intent: Intent %u Tie breaker %u", 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt go_intent >> 1, go_intent & 0x01); 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_listen_channel(struct wpabuf *buf, const char *country, 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 reg_class, u8 channel) 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Listen Channel */ 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_LISTEN_CHANNEL); 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 5); 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, country, 3); 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, reg_class); /* Regulatory Class */ 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, channel); /* Channel Number */ 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Listen Channel: Regulatory Class %u " 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Channel %u", reg_class, channel); 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_operating_channel(struct wpabuf *buf, const char *country, 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 reg_class, u8 channel) 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Operating Channel */ 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_OPERATING_CHANNEL); 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 5); 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, country, 3); 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, reg_class); /* Regulatory Class */ 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, channel); /* Channel Number */ 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Operating Channel: Regulatory Class %u " 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Channel %u", reg_class, channel); 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_channel_list(struct wpabuf *buf, const char *country, 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_channels *chan) 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i; 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Channel List */ 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CHANNEL_LIST); 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 2); /* IE length to be filled */ 1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, country, 3); /* Country String */ 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < chan->reg_classes; i++) { 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_reg_class *c = &chan->reg_class[i]; 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, c->reg_class); 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, c->channels); 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, c->channel, c->channels); 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update attribute length */ 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(len, (u8 *) wpabuf_put(buf, 0) - len - 2); 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Channel List"); 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_status(struct wpabuf *buf, u8 status) 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Status */ 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_STATUS); 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 1); 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, status); 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Status: %d", status); 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_device_info(struct wpabuf *buf, struct p2p_data *p2p, 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_device *peer) 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 methods; 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t nlen, i; 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device Info */ 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_DEVICE_INFO); 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 2); /* IE length to be filled */ 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device address */ 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN); 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Config Methods */ 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods = 0; 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer && peer->wps_method != WPS_NOT_READY) { 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->wps_method == WPS_PBC) 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_PUSHBUTTON; 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (peer->wps_method == WPS_PIN_DISPLAY || 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->wps_method == WPS_PIN_KEYPAD) 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD; 1771f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } else if (p2p->cfg->config_methods) { 1781f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt methods |= p2p->cfg->config_methods & 1791f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt (WPS_CONFIG_PUSHBUTTON | WPS_CONFIG_DISPLAY | 1801f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt WPS_CONFIG_KEYPAD); 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_PUSHBUTTON; 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD; 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, methods); 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Primary Device Type */ 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->pri_dev_type, 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(p2p->cfg->pri_dev_type)); 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Number of Secondary Device Types */ 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, p2p->cfg->num_sec_dev_types); 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Secondary Device Type List */ 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < p2p->cfg->num_sec_dev_types; i++) 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->sec_dev_type[i], 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_DEV_TYPE_LEN); 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Device Name */ 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt nlen = p2p->cfg->dev_name ? os_strlen(p2p->cfg->dev_name) : 0; 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_DEV_NAME); 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, nlen); 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_name, nlen); 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update attribute length */ 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(len, (u8 *) wpabuf_put(buf, 0) - len - 2); 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Device Info"); 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_device_id(struct wpabuf *buf, const u8 *dev_addr) 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device ID */ 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_DEVICE_ID); 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN); 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, dev_addr, ETH_ALEN); 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Device ID: " MACSTR, MAC2STR(dev_addr)); 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_config_timeout(struct wpabuf *buf, u8 go_timeout, 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 client_timeout) 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Configuration Timeout */ 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CONFIGURATION_TIMEOUT); 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 2); 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, go_timeout); 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, client_timeout); 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Configuration Timeout: GO %d (*10ms) " 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "client %d (*10ms)", go_timeout, client_timeout); 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_intended_addr(struct wpabuf *buf, const u8 *interface_addr) 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Intended P2P Interface Address */ 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_INTENDED_INTERFACE_ADDR); 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN); 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, interface_addr, ETH_ALEN); 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Intended P2P Interface Address " MACSTR, 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(interface_addr)); 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_group_bssid(struct wpabuf *buf, const u8 *bssid) 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Group BSSID */ 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_GROUP_BSSID); 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN); 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, bssid, ETH_ALEN); 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P Group BSSID " MACSTR, 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(bssid)); 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_group_id(struct wpabuf *buf, const u8 *dev_addr, 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *ssid, size_t ssid_len) 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Group ID */ 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_GROUP_ID); 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN + ssid_len); 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, dev_addr, ETH_ALEN); 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, ssid, ssid_len); 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P Group ID " MACSTR, 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(dev_addr)); 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_invitation_flags(struct wpabuf *buf, u8 flags) 2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Invitation Flags */ 2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_INVITATION_FLAGS); 2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 1); 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, flags); 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Invitation Flags: bitmap 0x%x", flags); 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void p2p_buf_add_noa_desc(struct wpabuf *buf, struct p2p_noa_desc *desc) 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (desc == NULL) 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, desc->count_type); 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le32(buf, desc->duration); 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le32(buf, desc->interval); 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le32(buf, desc->start_time); 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_noa(struct wpabuf *buf, u8 noa_index, u8 opp_ps, u8 ctwindow, 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_noa_desc *desc1, struct p2p_noa_desc *desc2) 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Notice of Absence */ 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_NOTICE_OF_ABSENCE); 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 2 + (desc1 ? 13 : 0) + (desc2 ? 13 : 0)); 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, noa_index); 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, (opp_ps ? 0x80 : 0) | (ctwindow & 0x7f)); 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_buf_add_noa_desc(buf, desc1); 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_buf_add_noa_desc(buf, desc2); 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Notice of Absence"); 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_ext_listen_timing(struct wpabuf *buf, u16 period, 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 interval) 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Extended Listen Timing */ 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_EXT_LISTEN_TIMING); 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 4); 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, period); 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, interval); 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Extended Listen Timing (period %u msec " 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "interval %u msec)", period, interval); 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_p2p_interface(struct wpabuf *buf, struct p2p_data *p2p) 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Interface */ 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_INTERFACE); 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN + 1 + ETH_ALEN); 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device address */ 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN); 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * FIX: Fetch interface address list from driver. Do not include 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the P2P Device address if it is never used as interface address. 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Interface Address Count */ 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, 1); 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN); 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void p2p_add_wps_string(struct wpabuf *buf, enum wps_attribute attr, 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *val) 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, attr); 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = val ? os_strlen(val) : 0; 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef CONFIG_WPS_STRICT 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len == 0) { 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Some deployed WPS implementations fail to parse zeor-length 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * attributes. As a workaround, send a space character if the 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * device attribute string is empty. 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 1); 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, ' '); 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_STRICT */ 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, len); 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (val) 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, val, len); 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_build_wps_ie(struct p2p_data *p2p, struct wpabuf *buf, u16 pw_id, 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int all_attr) 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC); 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 1); 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be32(buf, WPS_DEV_OUI_WFA); 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_build_version(buf); 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (all_attr) { 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_WPS_STATE); 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 1); 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WPS_STATE_NOT_CONFIGURED); 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Device Password ID */ 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_DEV_PASSWORD_ID); 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 2); 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: WPS IE Device Password ID: %d", pw_id); 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, pw_id); 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (all_attr) { 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_RESPONSE_TYPE); 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 1); 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WPS_RESP_ENROLLEE_INFO); 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_build_uuid_e(buf, p2p->cfg->uuid); 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_add_wps_string(buf, ATTR_MANUFACTURER, 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p->cfg->manufacturer); 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_add_wps_string(buf, ATTR_MODEL_NAME, p2p->cfg->model_name); 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_add_wps_string(buf, ATTR_MODEL_NUMBER, 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p->cfg->model_number); 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_add_wps_string(buf, ATTR_SERIAL_NUMBER, 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p->cfg->serial_number); 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_PRIMARY_DEV_TYPE); 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, WPS_DEV_TYPE_LEN); 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->pri_dev_type, WPS_DEV_TYPE_LEN); 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_add_wps_string(buf, ATTR_DEV_NAME, p2p->cfg->dev_name); 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_CONFIG_METHODS); 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 2); 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, p2p->cfg->config_methods); 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_build_wfa_ext(buf, 0, NULL, 0); 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (all_attr && p2p->cfg->num_sec_dev_types) { 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_SECONDARY_DEV_TYPE_LIST); 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, WPS_DEV_TYPE_LEN * 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p->cfg->num_sec_dev_types); 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->sec_dev_type, 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_DEV_TYPE_LEN * 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p->cfg->num_sec_dev_types); 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Add the WPS vendor extensions */ 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < P2P_MAX_WPS_VENDOR_EXT; i++) { 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (p2p->wps_vendor_ext[i] == NULL) 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpabuf_tailroom(buf) < 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4 + wpabuf_len(p2p->wps_vendor_ext[i])) 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_VENDOR_EXT); 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, wpabuf_len(p2p->wps_vendor_ext[i])); 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_buf(buf, p2p->wps_vendor_ext[i]); 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_buf_update_ie_hdr(buf, len); 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 434