p2p_build.c revision aff761db795db8b506c6f6af7ff607856cf85a81
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" 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps/wps_i.h" 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "p2p_i.h" 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_action_hdr(struct wpabuf *buf, u8 subtype, u8 dialog_token) 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_ACTION_VENDOR_SPECIFIC); 20a38abf9af7bec7e89dbfb39ac7bb77223fe47c72Dmitry Shmidt wpabuf_put_be32(buf, P2P_IE_VENDOR_TYPE); 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, subtype); /* OUI Subtype */ 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, dialog_token); 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Dialog Token: %d", dialog_token); 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_public_action_hdr(struct wpabuf *buf, u8 subtype, 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dialog_token) 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_ACTION_PUBLIC); 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_PA_VENDOR_SPECIFIC); 33a38abf9af7bec7e89dbfb39ac7bb77223fe47c72Dmitry Shmidt wpabuf_put_be32(buf, P2P_IE_VENDOR_TYPE); 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, subtype); /* OUI Subtype */ 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, dialog_token); 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Dialog Token: %d", dialog_token); 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtu8 * p2p_buf_add_ie_hdr(struct wpabuf *buf) 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P IE header */ 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC); 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 1); /* IE length to be filled */ 48a38abf9af7bec7e89dbfb39ac7bb77223fe47c72Dmitry Shmidt wpabuf_put_be32(buf, P2P_IE_VENDOR_TYPE); 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P IE header"); 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return len; 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_update_ie_hdr(struct wpabuf *buf, u8 *len) 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update P2P IE Length */ 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *len = (u8 *) wpabuf_put(buf, 0) - len - 1; 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_capability(struct wpabuf *buf, u8 dev_capab, u8 group_capab) 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Capability */ 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CAPABILITY); 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 2); 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, dev_capab); /* Device Capabilities */ 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, group_capab); /* Group Capabilities */ 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Capability dev=%02x group=%02x", 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dev_capab, group_capab); 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_go_intent(struct wpabuf *buf, u8 go_intent) 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Group Owner Intent */ 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_GROUP_OWNER_INTENT); 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 1); 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, go_intent); 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * GO Intent: Intent %u Tie breaker %u", 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt go_intent >> 1, go_intent & 0x01); 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_listen_channel(struct wpabuf *buf, const char *country, 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 reg_class, u8 channel) 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Listen Channel */ 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_LISTEN_CHANNEL); 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 5); 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, country, 3); 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, reg_class); /* Regulatory Class */ 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, channel); /* Channel Number */ 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Listen Channel: Regulatory Class %u " 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Channel %u", reg_class, channel); 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_operating_channel(struct wpabuf *buf, const char *country, 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 reg_class, u8 channel) 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Operating Channel */ 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_OPERATING_CHANNEL); 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 5); 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, country, 3); 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, reg_class); /* Regulatory Class */ 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, channel); /* Channel Number */ 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Operating Channel: Regulatory Class %u " 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Channel %u", reg_class, channel); 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_channel_list(struct wpabuf *buf, const char *country, 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_channels *chan) 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i; 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Channel List */ 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CHANNEL_LIST); 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 2); /* IE length to be filled */ 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, country, 3); /* Country String */ 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < chan->reg_classes; i++) { 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_reg_class *c = &chan->reg_class[i]; 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, c->reg_class); 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, c->channels); 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, c->channel, c->channels); 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update attribute length */ 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(len, (u8 *) wpabuf_put(buf, 0) - len - 2); 13291c40cdce17424d9a4718876becf0b7811cf68f2Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "P2P: * Channel List", 13391c40cdce17424d9a4718876becf0b7811cf68f2Dmitry Shmidt len + 2, (u8 *) wpabuf_put(buf, 0) - len - 2); 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 136d5e4923d04122f81300fa68fb07d64ede28fd44dDmitry Shmidt 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_status(struct wpabuf *buf, u8 status) 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Status */ 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_STATUS); 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 1); 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, status); 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Status: %d", status); 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_device_info(struct wpabuf *buf, struct p2p_data *p2p, 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_device *peer) 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 methods; 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t nlen, i; 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device Info */ 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_DEVICE_INFO); 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 2); /* IE length to be filled */ 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device address */ 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN); 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Config Methods */ 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods = 0; 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer && peer->wps_method != WPS_NOT_READY) { 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->wps_method == WPS_PBC) 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_PUSHBUTTON; 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (peer->wps_method == WPS_PIN_DISPLAY || 167aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt peer->wps_method == WPS_PIN_KEYPAD) { 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD; 169aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt methods |= WPS_CONFIG_P2PS; 170aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 1711f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } else if (p2p->cfg->config_methods) { 1721f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt methods |= p2p->cfg->config_methods & 1731f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt (WPS_CONFIG_PUSHBUTTON | WPS_CONFIG_DISPLAY | 174aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt WPS_CONFIG_KEYPAD | WPS_CONFIG_P2PS); 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_PUSHBUTTON; 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt methods |= WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD; 178aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt methods |= WPS_CONFIG_P2PS; 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, methods); 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Primary Device Type */ 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->pri_dev_type, 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(p2p->cfg->pri_dev_type)); 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Number of Secondary Device Types */ 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, p2p->cfg->num_sec_dev_types); 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Secondary Device Type List */ 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < p2p->cfg->num_sec_dev_types; i++) 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->sec_dev_type[i], 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_DEV_TYPE_LEN); 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Device Name */ 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt nlen = p2p->cfg->dev_name ? os_strlen(p2p->cfg->dev_name) : 0; 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_DEV_NAME); 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, nlen); 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_name, nlen); 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Update attribute length */ 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(len, (u8 *) wpabuf_put(buf, 0) - len - 2); 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Device Info"); 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_device_id(struct wpabuf *buf, const u8 *dev_addr) 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device ID */ 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_DEVICE_ID); 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN); 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, dev_addr, ETH_ALEN); 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Device ID: " MACSTR, MAC2STR(dev_addr)); 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_config_timeout(struct wpabuf *buf, u8 go_timeout, 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 client_timeout) 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Configuration Timeout */ 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CONFIGURATION_TIMEOUT); 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 2); 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, go_timeout); 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, client_timeout); 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Configuration Timeout: GO %d (*10ms) " 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "client %d (*10ms)", go_timeout, client_timeout); 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_intended_addr(struct wpabuf *buf, const u8 *interface_addr) 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Intended P2P Interface Address */ 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_INTENDED_INTERFACE_ADDR); 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN); 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, interface_addr, ETH_ALEN); 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Intended P2P Interface Address " MACSTR, 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(interface_addr)); 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_group_bssid(struct wpabuf *buf, const u8 *bssid) 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Group BSSID */ 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_GROUP_BSSID); 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN); 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, bssid, ETH_ALEN); 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P Group BSSID " MACSTR, 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(bssid)); 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_group_id(struct wpabuf *buf, const u8 *dev_addr, 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *ssid, size_t ssid_len) 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Group ID */ 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_GROUP_ID); 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN + ssid_len); 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, dev_addr, ETH_ALEN); 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, ssid, ssid_len); 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P Group ID " MACSTR, 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(dev_addr)); 2615460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "P2P: P2P Group ID SSID", ssid, ssid_len); 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_invitation_flags(struct wpabuf *buf, u8 flags) 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Invitation Flags */ 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_INVITATION_FLAGS); 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 1); 2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, flags); 2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Invitation Flags: bitmap 0x%x", flags); 2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void p2p_buf_add_noa_desc(struct wpabuf *buf, struct p2p_noa_desc *desc) 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (desc == NULL) 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, desc->count_type); 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le32(buf, desc->duration); 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le32(buf, desc->interval); 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le32(buf, desc->start_time); 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_noa(struct wpabuf *buf, u8 noa_index, u8 opp_ps, u8 ctwindow, 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_noa_desc *desc1, struct p2p_noa_desc *desc2) 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Notice of Absence */ 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_NOTICE_OF_ABSENCE); 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 2 + (desc1 ? 13 : 0) + (desc2 ? 13 : 0)); 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, noa_index); 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, (opp_ps ? 0x80 : 0) | (ctwindow & 0x7f)); 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_buf_add_noa_desc(buf, desc1); 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_buf_add_noa_desc(buf, desc2); 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Notice of Absence"); 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_ext_listen_timing(struct wpabuf *buf, u16 period, 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 interval) 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Extended Listen Timing */ 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_EXT_LISTEN_TIMING); 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, 4); 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, period); 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, interval); 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Extended Listen Timing (period %u msec " 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "interval %u msec)", period, interval); 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid p2p_buf_add_p2p_interface(struct wpabuf *buf, struct p2p_data *p2p) 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Interface */ 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_INTERFACE); 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN + 1 + ETH_ALEN); 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Device address */ 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN); 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * FIX: Fetch interface address list from driver. Do not include 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the P2P Device address if it is never used as interface address. 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Interface Address Count */ 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, 1); 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->dev_addr, ETH_ALEN); 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 331cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidtvoid p2p_buf_add_oob_go_neg_channel(struct wpabuf *buf, const char *country, 332cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt u8 oper_class, u8 channel, 333cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt enum p2p_role_indication role) 334cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt{ 335cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt /* OOB Group Owner Negotiation Channel */ 336cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_OOB_GO_NEG_CHANNEL); 337cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_le16(buf, 6); 338cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_data(buf, country, 3); 339cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_u8(buf, oper_class); /* Operating Class */ 340cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_u8(buf, channel); /* Channel Number */ 341cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpabuf_put_u8(buf, (u8) role); /* Role indication */ 342cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * OOB GO Negotiation Channel: Operating " 343cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt "Class %u Channel %u Role %d", 344cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt oper_class, channel, role); 345cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt} 346cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt 347cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt 348aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_service_hash(struct wpabuf *buf, struct p2p_data *p2p) 349aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 350aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!p2p) 351aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 352aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 353aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Service Hash */ 354aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_SERVICE_HASH); 355aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, p2p->p2ps_seek_count * P2PS_HASH_LEN); 356aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, p2p->query_hash, 357aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt p2p->p2ps_seek_count * P2PS_HASH_LEN); 358aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "P2P: * Service Hash", 359aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt p2p->query_hash, p2p->p2ps_seek_count * P2PS_HASH_LEN); 360aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 361aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 362aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 363aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_session_info(struct wpabuf *buf, const char *info) 364aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 365aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt size_t info_len = 0; 366aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 367aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (info && info[0]) 368aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt info_len = os_strlen(info); 369aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 370aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Session Information Data Info */ 371aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_SESSION_INFORMATION_DATA); 372aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, (u16) info_len); 373aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 374aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (info) { 375aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, info, info_len); 376aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Session Info Data (%s)", info); 377aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 378aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 379aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 380aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 381aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_connection_capability(struct wpabuf *buf, u8 connection_cap) 382aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 383aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Connection Capability Info */ 384aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_CONNECTION_CAPABILITY); 385aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, 1); 386aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, connection_cap); 387aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Connection Capability: 0x%x", 388aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt connection_cap); 389aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 390aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 391aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 392aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_advertisement_id(struct wpabuf *buf, u32 id, const u8 *mac) 393aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 394aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!buf || !mac) 395aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 396aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 397aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Advertisement ID Info */ 398aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_ADVERTISEMENT_ID); 399aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, (u16) (sizeof(u32) + ETH_ALEN)); 400aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le32(buf, id); 401aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, mac, ETH_ALEN); 402aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Advertisement ID (%x) " MACSTR, 403aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt id, MAC2STR(mac)); 404aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 405aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 406aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 407aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_service_instance(struct wpabuf *buf, struct p2p_data *p2p, 408aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt u8 hash_count, const u8 *hash, 409aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt struct p2ps_advertisement *adv_list) 410aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 411aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt struct p2ps_advertisement *adv; 412aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt struct wpabuf *tmp_buf; 413aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt u8 *tag_len = NULL, *ie_len = NULL; 414aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt size_t svc_len = 0, remaining = 0, total_len = 0; 415aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 416aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!adv_list || !hash) 417aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 418aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 419aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Allocate temp buffer, allowing for overflow of 1 instance */ 420aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt tmp_buf = wpabuf_alloc(MAX_SVC_ADV_IE_LEN + 256 + P2PS_HASH_LEN); 421aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!tmp_buf) 422aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 423aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 424aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt for (adv = adv_list; adv && total_len <= MAX_SVC_ADV_LEN; 425aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt adv = adv->next) { 426aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt u8 count = hash_count; 427aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt const u8 *test = hash; 428aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 429aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt while (count--) { 430aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Check for wildcard */ 431aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (os_memcmp(test, p2p->wild_card_hash, 432aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt P2PS_HASH_LEN) == 0) { 433aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt total_len = MAX_SVC_ADV_LEN + 1; 434aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt goto wild_hash; 435aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 436aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 437aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (os_memcmp(test, adv->hash, P2PS_HASH_LEN) == 0) 438aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt goto hash_match; 439aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 440aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt test += P2PS_HASH_LEN; 441aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 442aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 443aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* No matches found - Skip this Adv Instance */ 444aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt continue; 445aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 446aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidthash_match: 447aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!tag_len) { 448aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt tag_len = p2p_buf_add_ie_hdr(tmp_buf); 449aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt remaining = 255 - 4; 450aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!ie_len) { 451aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(tmp_buf, 452aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt P2P_ATTR_ADVERTISED_SERVICE); 453aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt ie_len = wpabuf_put(tmp_buf, sizeof(u16)); 454aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt remaining -= (sizeof(u8) + sizeof(u16)); 455aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 456aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 457aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 458aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt svc_len = os_strlen(adv->svc_name); 459aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 460aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (7 + svc_len + total_len > MAX_SVC_ADV_LEN) { 461aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Can't fit... return wildcard */ 462aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt total_len = MAX_SVC_ADV_LEN + 1; 463aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt break; 464aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 465aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 466aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (remaining <= (sizeof(adv->id) + 467aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt sizeof(adv->config_methods))) { 468aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt size_t front = remaining; 469aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt size_t back = (sizeof(adv->id) + 470aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt sizeof(adv->config_methods)) - front; 471aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt u8 holder[sizeof(adv->id) + 472aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt sizeof(adv->config_methods)]; 473aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 474aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* This works even if front or back == 0 */ 475aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt WPA_PUT_LE32(holder, adv->id); 476aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt WPA_PUT_BE16(&holder[sizeof(adv->id)], 477aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt adv->config_methods); 478aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(tmp_buf, holder, front); 479aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt p2p_buf_update_ie_hdr(tmp_buf, tag_len); 480aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt tag_len = p2p_buf_add_ie_hdr(tmp_buf); 481aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(tmp_buf, &holder[front], back); 482aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt remaining = 255 - (sizeof(adv->id) + 483aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt sizeof(adv->config_methods)) - back; 484aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } else { 485aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le32(tmp_buf, adv->id); 486aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_be16(tmp_buf, adv->config_methods); 487aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt remaining -= (sizeof(adv->id) + 488aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt sizeof(adv->config_methods)); 489aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 490aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 491aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* We are guaranteed at least one byte for svc_len */ 492aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(tmp_buf, svc_len); 493aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt remaining -= sizeof(u8); 494aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 495aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (remaining < svc_len) { 496aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt size_t front = remaining; 497aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt size_t back = svc_len - front; 498aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 499aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(tmp_buf, adv->svc_name, front); 500aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt p2p_buf_update_ie_hdr(tmp_buf, tag_len); 501aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt tag_len = p2p_buf_add_ie_hdr(tmp_buf); 502aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 503aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* In rare cases, we must split across 3 attributes */ 504aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (back > 255 - 4) { 505aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(tmp_buf, 506aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt &adv->svc_name[front], 255 - 4); 507aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt back -= 255 - 4; 508aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt front += 255 - 4; 509aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt p2p_buf_update_ie_hdr(tmp_buf, tag_len); 510aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt tag_len = p2p_buf_add_ie_hdr(tmp_buf); 511aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 512aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 513aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(tmp_buf, &adv->svc_name[front], back); 514aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt remaining = 255 - 4 - back; 515aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } else { 516aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(tmp_buf, adv->svc_name, svc_len); 517aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt remaining -= svc_len; 518aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 519aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 520aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* adv_id config_methods svc_string */ 521aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt total_len += sizeof(u32) + sizeof(u16) + sizeof(u8) + svc_len; 522aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 523aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 524aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (tag_len) 525aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt p2p_buf_update_ie_hdr(tmp_buf, tag_len); 526aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 527aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (ie_len) 528aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt WPA_PUT_LE16(ie_len, (u16) total_len); 529aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 530aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtwild_hash: 531aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* If all fit, return matching instances, otherwise the wildcard */ 532aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (total_len <= MAX_SVC_ADV_LEN) { 533aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_buf(buf, tmp_buf); 534aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } else { 535aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt char *wild_card = P2PS_WILD_HASH_STR; 536aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt u8 wild_len; 537aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 538aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Insert wildcard instance */ 539aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt tag_len = p2p_buf_add_ie_hdr(buf); 540aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_ADVERTISED_SERVICE); 541aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt ie_len = wpabuf_put(buf, sizeof(u16)); 542aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 543aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wild_len = (u8) os_strlen(wild_card); 544aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le32(buf, 0); 545aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_be16(buf, 0); 546aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, wild_len); 547aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, wild_card, wild_len); 548aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 549aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt WPA_PUT_LE16(ie_len, 4 + 2 + 1 + wild_len); 550aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt p2p_buf_update_ie_hdr(buf, tag_len); 551aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt } 552aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 553aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_free(tmp_buf); 554aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 555aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 556aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 557aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_session_id(struct wpabuf *buf, u32 id, const u8 *mac) 558aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 559aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!buf || !mac) 560aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 561aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 562aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Session ID Info */ 563aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_SESSION_ID); 564aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, (u16) (sizeof(u32) + ETH_ALEN)); 565aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le32(buf, id); 566aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, mac, ETH_ALEN); 567aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Session ID Info (%x) " MACSTR, 568aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt id, MAC2STR(mac)); 569aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 570aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 571aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 572aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_feature_capability(struct wpabuf *buf, u16 len, const u8 *mask) 573aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 574aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt if (!buf || !len || !mask) 575aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt return; 576aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 577aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* Feature Capability */ 578aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_FEATURE_CAPABILITY); 579aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, len); 580aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, mask, len); 581aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * Feature Capability (%d)", len); 582aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 583aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 584aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 585aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidtvoid p2p_buf_add_persistent_group_info(struct wpabuf *buf, const u8 *dev_addr, 586aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt const u8 *ssid, size_t ssid_len) 587aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt{ 588aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt /* P2P Group ID */ 589aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_u8(buf, P2P_ATTR_PERSISTENT_GROUP); 590aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_le16(buf, ETH_ALEN + ssid_len); 591aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, dev_addr, ETH_ALEN); 592aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpabuf_put_data(buf, ssid, ssid_len); 593aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: * P2P Group ID " MACSTR, 594aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt MAC2STR(dev_addr)); 595aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt} 596aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 597aff761db795db8b506c6f6af7ff607856cf85a81Dmitry Shmidt 59868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidtstatic int p2p_add_wps_string(struct wpabuf *buf, enum wps_attribute attr, 59968d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt const char *val) 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = val ? os_strlen(val) : 0; 60468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 4 + len) 60568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 60668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt wpabuf_put_be16(buf, attr); 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef CONFIG_WPS_STRICT 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len == 0) { 6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Some deployed WPS implementations fail to parse zeor-length 6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * attributes. As a workaround, send a space character if the 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * device attribute string is empty. 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 61468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 3) 61568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 1); 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, ' '); 61868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return 0; 6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_STRICT */ 6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, len); 6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (val) 6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, val, len); 62468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return 0; 6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 62868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidtint p2p_build_wps_ie(struct p2p_data *p2p, struct wpabuf *buf, int pw_id, 62968d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt int all_attr) 6308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *len; 6328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 63468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 6) 63568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC); 6378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = wpabuf_put(buf, 1); 6388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be32(buf, WPS_DEV_OUI_WFA); 6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 64068d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wps_build_version(buf) < 0) 64168d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (all_attr) { 64468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 5) 64568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_WPS_STATE); 6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 1); 6488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WPS_STATE_NOT_CONFIGURED); 6498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 65104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (pw_id >= 0) { 65268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 6) 65368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 65404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Device Password ID */ 65504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpabuf_put_be16(buf, ATTR_DEV_PASSWORD_ID); 65604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpabuf_put_be16(buf, 2); 65704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: WPS IE Device Password ID: %d", 65804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt pw_id); 65904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpabuf_put_be16(buf, pw_id); 66004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (all_attr) { 66368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 5) 66468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_RESPONSE_TYPE); 6668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 1); 6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(buf, WPS_RESP_ENROLLEE_INFO); 6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 66968d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wps_build_uuid_e(buf, p2p->cfg->uuid) < 0 || 67068d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p_add_wps_string(buf, ATTR_MANUFACTURER, 67168d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p->cfg->manufacturer) < 0 || 67268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p_add_wps_string(buf, ATTR_MODEL_NAME, 67368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p->cfg->model_name) < 0 || 67468d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p_add_wps_string(buf, ATTR_MODEL_NUMBER, 67568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p->cfg->model_number) < 0 || 67668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p_add_wps_string(buf, ATTR_SERIAL_NUMBER, 67768d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt p2p->cfg->serial_number) < 0) 67868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 67968d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt 68068d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 4 + WPS_DEV_TYPE_LEN) 68168d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_PRIMARY_DEV_TYPE); 6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, WPS_DEV_TYPE_LEN); 6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->pri_dev_type, WPS_DEV_TYPE_LEN); 6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 68668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (p2p_add_wps_string(buf, ATTR_DEV_NAME, p2p->cfg->dev_name) 68768d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt < 0) 68868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 69068d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 6) 69168d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 6928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_CONFIG_METHODS); 6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, 2); 6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, p2p->cfg->config_methods); 6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 69768d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wps_build_wfa_ext(buf, 0, NULL, 0) < 0) 69868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 6998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (all_attr && p2p->cfg->num_sec_dev_types) { 70168d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt if (wpabuf_tailroom(buf) < 70268d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt 4 + WPS_DEV_TYPE_LEN * p2p->cfg->num_sec_dev_types) 70368d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return -1; 7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_SECONDARY_DEV_TYPE_LIST); 7058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, WPS_DEV_TYPE_LEN * 7068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p->cfg->num_sec_dev_types); 7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(buf, p2p->cfg->sec_dev_type, 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_DEV_TYPE_LEN * 7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p->cfg->num_sec_dev_types); 7108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Add the WPS vendor extensions */ 7138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < P2P_MAX_WPS_VENDOR_EXT; i++) { 7148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (p2p->wps_vendor_ext[i] == NULL) 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpabuf_tailroom(buf) < 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4 + wpabuf_len(p2p->wps_vendor_ext[i])) 7188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, ATTR_VENDOR_EXT); 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(buf, wpabuf_len(p2p->wps_vendor_ext[i])); 7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_buf(buf, p2p->wps_vendor_ext[i]); 7228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_buf_update_ie_hdr(buf, len); 72568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt 72668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt return 0; 7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 728