tdls.c revision 51b6ea882f234c14cd1fe1332a3840cf61fafcca
18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_supplicant - TDLS 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2010-2011, 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 "utils/includes.h" 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/common.h" 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/eloop.h" 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/os.h" 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common/ieee802_11_defs.h" 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "crypto/sha256.h" 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "crypto/crypto.h" 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "crypto/aes_wrap.h" 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "rsn_supp/wpa.h" 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "rsn_supp/wpa_ie.h" 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "rsn_supp/wpa_i.h" 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "drivers/driver.h" 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "l2_packet/l2_packet.h" 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_LONG_FRAME BIT(0) 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_ALT_RSN_IE BIT(1) 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_DIFF_BSSID BIT(2) 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_SHORT_LIFETIME BIT(3) 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_WRONG_LIFETIME_RESP BIT(4) 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_WRONG_LIFETIME_CONF BIT(5) 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_LONG_LIFETIME BIT(6) 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_CONCURRENT_INIT BIT(7) 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_NO_TPK_EXPIRATION BIT(8) 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_DECLINE_RESP BIT(9) 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TESTING_IGNORE_AP_PROHIBIT BIT(10) 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtunsigned int tdls_testing = 0; 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TPK_LIFETIME 43200 /* 12 hours */ 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TPK_RETRY_COUNT 3 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TPK_TIMEOUT 5000 /* in milliseconds */ 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_MIC_LEN 16 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_TIMEOUT_LEN 4 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wpa_tdls_ftie { 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ie_type; /* FTIE */ 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ie_len; 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 mic_ctrl[2]; 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 mic[TDLS_MIC_LEN]; 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 Anonce[WPA_NONCE_LEN]; /* Responder Nonce in TDLS */ 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 Snonce[WPA_NONCE_LEN]; /* Initiator Nonce in TDLS */ 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* followed by optional elements */ 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} STRUCT_PACKED; 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wpa_tdls_timeoutie { 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ie_type; /* Timeout IE */ 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ie_len; 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 interval_type; 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 value[TDLS_TIMEOUT_LEN]; 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} STRUCT_PACKED; 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wpa_tdls_lnkid { 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ie_type; /* Link Identifier IE */ 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ie_len; 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 bssid[ETH_ALEN]; 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 init_sta[ETH_ALEN]; 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 resp_sta[ETH_ALEN]; 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} STRUCT_PACKED; 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* TDLS frame headers as per IEEE Std 802.11z-2010 */ 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wpa_tdls_frame { 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 payloadtype; /* IEEE80211_TDLS_RFTYPE */ 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 category; /* Category */ 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 action; /* Action (enum tdls_frame_type) */ 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} STRUCT_PACKED; 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic u8 * wpa_add_tdls_timeoutie(u8 *pos, u8 *ie, size_t ie_len, u32 tsecs); 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_tdls_tpk_retry_timeout(void *eloop_ctx, void *timeout_ctx); 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_tdls_peer_free(struct wpa_sm *sm, struct wpa_tdls_peer *peer); 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define TDLS_MAX_IE_LEN 80 851f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt#define IEEE80211_MAX_SUPP_RATES 32 861f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wpa_tdls_peer { 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *next; 898da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt unsigned int reconfig_key:1; 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int initiator; /* whether this end was initiator for TDLS setup */ 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 addr[ETH_ALEN]; /* other end MAC address */ 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 inonce[WPA_NONCE_LEN]; /* Initiator Nonce */ 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 rnonce[WPA_NONCE_LEN]; /* Responder Nonce */ 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 rsnie_i[TDLS_MAX_IE_LEN]; /* Initiator RSN IE */ 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t rsnie_i_len; 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 rsnie_p[TDLS_MAX_IE_LEN]; /* Peer RSN IE */ 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t rsnie_p_len; 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 lifetime; 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int cipher; /* Selected cipher (WPA_CIPHER_*) */ 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dtoken; 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct tpk { 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 kck[16]; /* TPK-KCK */ 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 tk[16]; /* TPK-TK; assuming only CCMP will be used */ 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } tpk; 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int tpk_set; 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int tpk_success; 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct tpk_timer { 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dest[ETH_ALEN]; 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int count; /* Retry Count */ 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int timer; /* Timeout in milliseconds */ 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 action_code; /* TDLS frame type */ 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dialog_token; 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 status_code; 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int buf_len; /* length of TPK message for retransmission */ 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *buf; /* buffer for TPK message */ 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } sm_tmr; 1191f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1201f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt u16 capability; 1211f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt u8 supp_rates[IEEE80211_MAX_SUPP_RATES]; 1231f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt size_t supp_rates_len; 124f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 125f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt struct ieee80211_ht_capabilities *ht_capabilities; 12633e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt struct ieee80211_vht_capabilities *vht_capabilities; 127f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 128f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt u8 qos_info; 129f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 13051b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt u16 aid; 13151b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt 132f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt u8 *ext_capab; 133f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt size_t ext_capab_len; 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_get_privacy(struct wpa_sm *sm) 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Get info needed from supplicant to check if the current BSS supports 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * security. Other than OPEN mode, rest are considered secured 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * WEP/WPA/WPA2 hence TDLS frames are processed for TPK handshake. 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return sm->pairwise_cipher != WPA_CIPHER_NONE; 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic u8 * wpa_add_ie(u8 *pos, const u8 *ie, size_t ie_len) 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, ie, ie_len); 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return pos + ie_len; 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_del_key(struct wpa_sm *sm, struct wpa_tdls_peer *peer) 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_sm_set_key(sm, WPA_ALG_NONE, peer->addr, 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 0, 0, NULL, 0, NULL, 0) < 0) { 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_WARNING, "TDLS: Failed to delete TPK-TK from " 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "the driver"); 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_set_key(struct wpa_sm *sm, struct wpa_tdls_peer *peer) 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 key_len; 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 rsc[6]; 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum wpa_alg alg; 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(rsc, 0, 6); 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (peer->cipher) { 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_CCMP: 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alg = WPA_ALG_CCMP; 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key_len = 16; 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_NONE: 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Pairwise Cipher Suite: " 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "NONE - do not use pairwise keys"); 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_WARNING, "TDLS: Unsupported pairwise cipher %d", 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sm->pairwise_cipher); 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_sm_set_key(sm, alg, peer->addr, -1, 1, 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rsc, sizeof(rsc), peer->tpk.tk, key_len) < 0) { 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_WARNING, "TDLS: Failed to set TPK to the " 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "driver"); 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_send_tpk_msg(struct wpa_sm *sm, const u8 *dst, 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 action_code, u8 dialog_token, 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 status_code, const u8 *buf, size_t len) 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return wpa_sm_send_tdls_mgmt(sm, dst, action_code, dialog_token, 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status_code, buf, len); 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_tpk_send(struct wpa_sm *sm, const u8 *dest, u8 action_code, 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dialog_token, u16 status_code, 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *msg, size_t msg_len) 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer; 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK send dest=" MACSTR " action_code=%u " 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "dialog_token=%u status_code=%u msg_len=%u", 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(dest), action_code, dialog_token, status_code, 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned int) msg_len); 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_tdls_send_tpk_msg(sm, dest, action_code, dialog_token, 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status_code, msg, msg_len)) { 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Failed to send message " 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(action_code=%u)", action_code); 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (action_code == WLAN_TDLS_SETUP_CONFIRM || 2291f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt action_code == WLAN_TDLS_TEARDOWN || 2301f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt action_code == WLAN_TDLS_DISCOVERY_REQUEST || 2311f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt action_code == WLAN_TDLS_DISCOVERY_RESPONSE) 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; /* No retries */ 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (peer = sm->tdls; peer; peer = peer->next) { 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(peer->addr, dest, ETH_ALEN) == 0) 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer == NULL) { 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No matching entry found for " 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "retry " MACSTR, MAC2STR(dest)); 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_tdls_tpk_retry_timeout, sm, peer); 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.count = TPK_RETRY_COUNT; 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.timer = TPK_TIMEOUT; 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Copy message to resend on timeout */ 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(peer->sm_tmr.dest, dest, ETH_ALEN); 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.action_code = action_code; 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.dialog_token = dialog_token; 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.status_code = status_code; 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.buf_len = msg_len; 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(peer->sm_tmr.buf); 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.buf = os_malloc(msg_len); 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->sm_tmr.buf == NULL) 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(peer->sm_tmr.buf, msg, msg_len); 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Retry timeout registered " 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(action_code=%u)", action_code); 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(peer->sm_tmr.timer / 1000, 0, 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_tpk_retry_timeout, sm, peer); 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2701f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int wpa_tdls_do_teardown(struct wpa_sm *sm, struct wpa_tdls_peer *peer, 2711f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt u16 reason_code, int free_peer) 2721f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 2731f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt int ret; 2741f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 2751f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_external_setup) { 2761f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt ret = wpa_tdls_send_teardown(sm, peer->addr, reason_code); 2771f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 2781f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* disable the link after teardown was sent */ 2791f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, peer->addr); 2801f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } else { 2811f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt ret = wpa_sm_tdls_oper(sm, TDLS_TEARDOWN, peer->addr); 2821f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 2831f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 2841f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_external_setup || free_peer) 2851f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_tdls_peer_free(sm, peer); 2861f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 2871f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return ret; 2881f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 2891f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 2901f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_tdls_tpk_retry_timeout(void *eloop_ctx, void *timeout_ctx) 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_sm *sm = eloop_ctx; 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer = timeout_ctx; 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->sm_tmr.count) { 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.count--; 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.timer = TPK_TIMEOUT; 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Retrying sending of message " 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(action_code=%u)", 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.action_code); 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->sm_tmr.buf == NULL) { 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No retry buffer available " 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "for action_code=%u", 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.action_code); 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_tdls_tpk_retry_timeout, sm, 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer); 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* resend TPK Handshake Message to Peer */ 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_tdls_send_tpk_msg(sm, peer->sm_tmr.dest, 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.action_code, 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.dialog_token, 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.status_code, 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.buf, 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.buf_len)) { 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Failed to retry " 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "transmission"); 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_tdls_tpk_retry_timeout, sm, peer); 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(peer->sm_tmr.timer / 1000, 0, 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_tpk_retry_timeout, sm, peer); 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_tdls_tpk_retry_timeout, sm, peer); 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3311f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Sending Teardown Request"); 3321f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_tdls_do_teardown(sm, peer, 3331f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt WLAN_REASON_TDLS_TEARDOWN_UNSPECIFIED, 1); 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_tdls_tpk_retry_timeout_cancel(struct wpa_sm *sm, 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer, 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 action_code) 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (action_code == peer->sm_tmr.action_code) { 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Retry timeout cancelled for " 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "action_code=%u", action_code); 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Cancel Timeout registered */ 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_tdls_tpk_retry_timeout, sm, peer); 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* free all resources meant for retry */ 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(peer->sm_tmr.buf); 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.buf = NULL; 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.count = 0; 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.timer = 0; 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.buf_len = 0; 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.action_code = 0xff; 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Error in cancelling retry timeout " 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(Unknown action_code=%u)", action_code); 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_tdls_generate_tpk(struct wpa_tdls_peer *peer, 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *own_addr, const u8 *bssid) 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 key_input[SHA256_MAC_LEN]; 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *nonce[2]; 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len[2]; 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 data[3 * ETH_ALEN]; 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* IEEE Std 802.11z-2010 8.5.9.1: 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * TPK-Key-Input = SHA-256(min(SNonce, ANonce) || max(SNonce, ANonce)) 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len[0] = WPA_NONCE_LEN; 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len[1] = WPA_NONCE_LEN; 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(peer->inonce, peer->rnonce, WPA_NONCE_LEN) < 0) { 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt nonce[0] = peer->inonce; 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt nonce[1] = peer->rnonce; 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt nonce[0] = peer->rnonce; 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt nonce[1] = peer->inonce; 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: min(Nonce)", nonce[0], WPA_NONCE_LEN); 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: max(Nonce)", nonce[1], WPA_NONCE_LEN); 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sha256_vector(2, nonce, len, key_input); 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_key(MSG_DEBUG, "TDLS: TPK-Key-Input", 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key_input, SHA256_MAC_LEN); 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * TPK-Key-Data = KDF-N_KEY(TPK-Key-Input, "TDLS PMK", 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * min(MAC_I, MAC_R) || max(MAC_I, MAC_R) || BSSID || N_KEY) 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * TODO: is N_KEY really included in KDF Context and if so, in which 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * presentation format (little endian 16-bit?) is it used? It gets 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * added by the KDF anyway.. 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(own_addr, peer->addr, ETH_ALEN) < 0) { 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(data, own_addr, ETH_ALEN); 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(data + ETH_ALEN, peer->addr, ETH_ALEN); 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(data, peer->addr, ETH_ALEN); 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(data + ETH_ALEN, own_addr, ETH_ALEN); 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(data + 2 * ETH_ALEN, bssid, ETH_ALEN); 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: KDF Context", data, sizeof(data)); 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sha256_prf(key_input, SHA256_MAC_LEN, "TDLS PMK", data, sizeof(data), 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) &peer->tpk, sizeof(peer->tpk)); 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_key(MSG_DEBUG, "TDLS: TPK-KCK", 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->tpk.kck, sizeof(peer->tpk.kck)); 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_key(MSG_DEBUG, "TDLS: TPK-TK", 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->tpk.tk, sizeof(peer->tpk.tk)); 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->tpk_set = 1; 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_tdls_ftie_mic - Calculate TDLS FTIE MIC 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @kck: TPK-KCK 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @lnkid: Pointer to the beginning of Link Identifier IE 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @rsnie: Pointer to the beginning of RSN IE used for handshake 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @timeoutie: Pointer to the beginning of Timeout IE used for handshake 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @ftie: Pointer to the beginning of FT IE 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @mic: Pointer for writing MIC 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Calculate MIC for TDLS frame. 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_ftie_mic(const u8 *kck, u8 trans_seq, const u8 *lnkid, 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *rsnie, const u8 *timeoutie, 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *ftie, u8 *mic) 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *buf, *pos; 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *_ftie; 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpa_tdls_lnkid *_lnkid; 4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int len = 2 * ETH_ALEN + 1 + 2 + lnkid[1] + 2 + rsnie[1] + 4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2 + timeoutie[1] + 2 + ftie[1]; 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = os_zalloc(len); 4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!buf) { 4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_WARNING, "TDLS: No memory for MIC calculation"); 4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = buf; 4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt _lnkid = (const struct wpa_tdls_lnkid *) lnkid; 4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1) TDLS initiator STA MAC address */ 4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, _lnkid->init_sta, ETH_ALEN); 4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ETH_ALEN; 4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 2) TDLS responder STA MAC address */ 4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, _lnkid->resp_sta, ETH_ALEN); 4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ETH_ALEN; 4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 3) Transaction Sequence number */ 4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = trans_seq; 4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 4) Link Identifier IE */ 4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, lnkid, 2 + lnkid[1]); 4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2 + lnkid[1]; 4588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 5) RSN IE */ 4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, rsnie, 2 + rsnie[1]); 4608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2 + rsnie[1]; 4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 6) Timeout Interval IE */ 4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, timeoutie, 2 + timeoutie[1]); 4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2 + timeoutie[1]; 4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 7) FTIE, with the MIC field of the FTIE set to 0 */ 4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, ftie, 2 + ftie[1]); 4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt _ftie = (struct wpa_tdls_ftie *) pos; 4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(_ftie->mic, 0, TDLS_MIC_LEN); 4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2 + ftie[1]; 4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Data for FTIE MIC", buf, pos - buf); 4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_key(MSG_DEBUG, "TDLS: KCK", kck, 16); 4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = omac1_aes_128(kck, buf, pos - buf, mic); 4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(buf); 4748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: FTIE MIC", mic, 16); 4758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 4808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_tdls_key_mic_teardown - Calculate TDLS FTIE MIC for Teardown frame 4818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @kck: TPK-KCK 4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @trans_seq: Transaction Sequence Number (4 - Teardown) 4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @rcode: Reason code for Teardown 4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @dtoken: Dialog Token used for that particular link 4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @lnkid: Pointer to the beginning of Link Identifier IE 4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @ftie: Pointer to the beginning of FT IE 4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @mic: Pointer for writing MIC 4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 4898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Calculate MIC for TDLS frame. 4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_key_mic_teardown(const u8 *kck, u8 trans_seq, u16 rcode, 4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dtoken, const u8 *lnkid, 4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *ftie, u8 *mic) 4948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *buf, *pos; 4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *_ftie; 4978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int len; 4998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (lnkid == NULL) 5018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = 2 + lnkid[1] + sizeof(rcode) + sizeof(dtoken) + 5048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(trans_seq) + 2 + ftie[1]; 5058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = os_zalloc(len); 5078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!buf) { 5088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_WARNING, "TDLS: No memory for MIC calculation"); 5098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = buf; 5138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1) Link Identifier IE */ 5148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, lnkid, 2 + lnkid[1]); 5158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2 + lnkid[1]; 5168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 2) Reason Code */ 5178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(pos, rcode); 5188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += sizeof(rcode); 5198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 3) Dialog token */ 5208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = dtoken; 5218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 4) Transaction Sequence number */ 5228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = trans_seq; 5238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 7) FTIE, with the MIC field of the FTIE set to 0 */ 5248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, ftie, 2 + ftie[1]); 5258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt _ftie = (struct wpa_tdls_ftie *) pos; 5268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(_ftie->mic, 0, TDLS_MIC_LEN); 5278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2 + ftie[1]; 5288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Data for FTIE MIC", buf, pos - buf); 5308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_key(MSG_DEBUG, "TDLS: KCK", kck, 16); 5318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = omac1_aes_128(kck, buf, pos - buf, mic); 5328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(buf); 5338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: FTIE MIC", mic, 16); 5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_supplicant_verify_tdls_mic(u8 trans_seq, 5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer, 5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *lnkid, const u8 *timeoutie, 5418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpa_tdls_ftie *ftie) 5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 mic[16]; 5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->tpk_set) { 5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_ftie_mic(peer->tpk.kck, trans_seq, lnkid, 5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_p, timeoutie, (u8 *) ftie, 5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mic); 5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(mic, ftie->mic, 16) != 0) { 5508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Invalid MIC in FTIE - " 5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "dropping packet"); 5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Received MIC", 5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->mic, 16); 5548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Calculated MIC", 5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mic, 16); 5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_WARNING, "TDLS: Could not verify TDLS MIC, " 5608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK not set - dropping packet"); 5618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 5648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_supplicant_verify_tdls_mic_teardown( 5688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 trans_seq, u16 rcode, u8 dtoken, struct wpa_tdls_peer *peer, 5698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *lnkid, const struct wpa_tdls_ftie *ftie) 5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 mic[16]; 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->tpk_set) { 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_key_mic_teardown(peer->tpk.kck, trans_seq, rcode, 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dtoken, lnkid, (u8 *) ftie, mic); 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(mic, ftie->mic, 16) != 0) { 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Invalid MIC in Teardown - " 5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "dropping packet"); 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Could not verify TDLS Teardown " 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MIC, TPK not set - dropping packet"); 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_tdls_tpk_timeout(void *eloop_ctx, void *timeout_ctx) 5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_sm *sm = eloop_ctx; 5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer = timeout_ctx; 5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * On TPK lifetime expiration, we have an option of either tearing down 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the direct link or trying to re-initiate it. The selection of what 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * to do is not strictly speaking controlled by our role in the expired 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * link, but for now, use that to select whether to renew or tear down 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the link. 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->initiator) { 6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK lifetime expired for " MACSTR 6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " - try to renew", MAC2STR(peer->addr)); 6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_start(sm, peer->addr); 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK lifetime expired for " MACSTR 6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " - tear down", MAC2STR(peer->addr)); 6101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_tdls_do_teardown(sm, peer, 6111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt WLAN_REASON_TDLS_TEARDOWN_UNSPECIFIED, 1); 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_tdls_peer_free(struct wpa_sm *sm, struct wpa_tdls_peer *peer) 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Clear state for peer " MACSTR, 6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(peer->addr)); 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_tdls_tpk_timeout, sm, peer); 6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_tdls_tpk_retry_timeout, sm, peer); 6228da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt peer->reconfig_key = 0; 6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->initiator = 0; 6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(peer->sm_tmr.buf); 6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->sm_tmr.buf = NULL; 626f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt os_free(peer->ht_capabilities); 627f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt peer->ht_capabilities = NULL; 62833e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt os_free(peer->vht_capabilities); 62933e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt peer->vht_capabilities = NULL; 630f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt os_free(peer->ext_capab); 631f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt peer->ext_capab = NULL; 6328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_i_len = peer->rsnie_p_len = 0; 6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->cipher = 0; 6348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->tpk_set = peer->tpk_success = 0; 6358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&peer->tpk, 0, sizeof(peer->tpk)); 6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(peer->inonce, 0, WPA_NONCE_LEN); 6378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(peer->rnonce, 0, WPA_NONCE_LEN); 6388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_tdls_linkid(struct wpa_sm *sm, struct wpa_tdls_peer *peer, 6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_lnkid *lnkid) 6438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lnkid->ie_type = WLAN_EID_LINK_ID; 6458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lnkid->ie_len = 3 * ETH_ALEN; 6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(lnkid->bssid, sm->bssid, ETH_ALEN); 6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer->initiator) { 6488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(lnkid->init_sta, sm->own_addr, ETH_ALEN); 6498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(lnkid->resp_sta, peer->addr, ETH_ALEN); 6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 6518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(lnkid->init_sta, peer->addr, ETH_ALEN); 6528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(lnkid->resp_sta, sm->own_addr, ETH_ALEN); 6538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6571f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtint wpa_tdls_send_teardown(struct wpa_sm *sm, const u8 *addr, u16 reason_code) 6588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer; 6608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *ftie; 6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_lnkid lnkid; 6628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dialog_token; 6638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *rbuf, *pos; 6648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ielen; 6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6661f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_disabled || !sm->tdls_supported) 6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Find the node and free from the list */ 6708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (peer = sm->tdls; peer; peer = peer->next) { 6718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(peer->addr, addr, ETH_ALEN) == 0) 6728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 6738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer == NULL) { 6768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No matching entry found for " 6778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Teardown " MACSTR, MAC2STR(addr)); 6788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dialog_token = peer->dtoken; 6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TDLS Teardown for " MACSTR, 6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(addr)); 6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = 0; 6878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_tdls_get_privacy(sm) && peer->tpk_set && peer->tpk_success) { 6888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* To add FTIE for Teardown request and compute MIC */ 6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen += sizeof(*ftie); 6908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 6918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_LONG_FRAME) 6928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen += 170; 6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rbuf = os_zalloc(ielen + 1); 6978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (rbuf == NULL) 6988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 6998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = rbuf; 7008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 70151b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt if (!wpa_tdls_get_privacy(sm) || !peer->tpk_set || !peer->tpk_success) 7028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_ies; 7038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie = (struct wpa_tdls_ftie *) pos; 7058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_type = WLAN_EID_FAST_BSS_TRANSITION; 7068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Using the recent nonce which should be for CONFIRM frame */ 7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ftie->Anonce, peer->rnonce, WPA_NONCE_LEN); 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ftie->Snonce, peer->inonce, WPA_NONCE_LEN); 7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_len = sizeof(struct wpa_tdls_ftie) - 2; 7108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = (u8 *) (ftie + 1); 7118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 7128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_LONG_FRAME) { 7138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - add extra subelem to " 7148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "FTIE"); 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_len += 170; 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 255; /* FTIE subelem */ 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 168; /* FTIE subelem length */ 7181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt pos += 168; 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: FTIE for TDLS Teardown handshake", 7221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt (u8 *) ftie, pos - (u8 *) ftie); 7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* compute MIC before sending */ 7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_linkid(sm, peer, &lnkid); 7268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_key_mic_teardown(peer->tpk.kck, 4, reason_code, 7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dialog_token, (u8 *) &lnkid, (u8 *) ftie, 7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->mic); 7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_ies: 7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO: register for a Timeout handler, if Teardown is not received at 7328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the other end, then try again another time */ 7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* request driver to send Teardown using this FTIE */ 7358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_tpk_send(sm, addr, WLAN_TDLS_TEARDOWN, 0, 7364b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt reason_code, rbuf, pos - rbuf); 7378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(rbuf); 7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* clear the Peerkey statemachine */ 7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_peer_free(sm, peer); 7418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 7438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7461f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtint wpa_tdls_teardown_link(struct wpa_sm *sm, const u8 *addr, u16 reason_code) 7471f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 7481f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt struct wpa_tdls_peer *peer; 7491f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7501f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_disabled || !sm->tdls_supported) 7511f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 7521f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7531f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt for (peer = sm->tdls; peer; peer = peer->next) { 7541f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (os_memcmp(peer->addr, addr, ETH_ALEN) == 0) 7551f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt break; 7561f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 7571f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7581f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (peer == NULL) { 7591f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Could not find peer " MACSTR 7601f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt " for link Teardown", MAC2STR(addr)); 7611f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 7621f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 7631f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7641f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (!peer->tpk_success) { 7651f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Peer " MACSTR 7661f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt " not connected - cannot Teardown link", MAC2STR(addr)); 7671f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 7681f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 7691f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7701f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return wpa_tdls_do_teardown(sm, peer, reason_code, 0); 7711f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 7721f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7731f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7741f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtvoid wpa_tdls_disable_link(struct wpa_sm *sm, const u8 *addr) 7751f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 7761f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt struct wpa_tdls_peer *peer; 7771f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7781f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt for (peer = sm->tdls; peer; peer = peer->next) { 7791f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (os_memcmp(peer->addr, addr, ETH_ALEN) == 0) 7801f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt break; 7811f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 7821f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7831f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (peer) { 7841f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, addr); 7851f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_tdls_peer_free(sm, peer); 7861f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 7871f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 7881f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7891f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 7908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_recv_teardown(struct wpa_sm *sm, const u8 *src_addr, 7918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *buf, size_t len) 7928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer = NULL; 7948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *ftie; 7958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_lnkid *lnkid; 7968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_eapol_ie_parse kde; 7978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 reason_code; 7988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *pos; 7998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ielen; 8008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Find the node and free from the list */ 8028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (peer = sm->tdls; peer; peer = peer->next) { 8038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(peer->addr, src_addr, ETH_ALEN) == 0) 8048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 8058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer == NULL) { 8088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No matching entry found for " 8098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Teardown " MACSTR, MAC2STR(src_addr)); 8108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 8118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = buf; 8148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 1 /* pkt_type */ + 1 /* Category */ + 1 /* Action */; 8158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt reason_code = WPA_GET_LE16(pos); 8178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 8188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TDLS Teardown Request from " MACSTR 8208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " (reason code %u)", MAC2STR(src_addr), reason_code); 8218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = len - (pos - buf); /* start of IE in buf */ 8238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_supplicant_parse_ies((const u8 *) pos, ielen, &kde) < 0) { 8248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Failed to parse IEs in Teardown"); 8258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 8268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.lnkid == NULL || kde.lnkid_len < 3 * ETH_ALEN) { 8298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No Link Identifier IE in TDLS " 8308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Teardown"); 8318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 8328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lnkid = (struct wpa_tdls_lnkid *) kde.lnkid; 8348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!wpa_tdls_get_privacy(sm) || !peer->tpk_set || !peer->tpk_success) 8368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_ftie; 8378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.ftie == NULL || kde.ftie_len < sizeof(*ftie)) { 8398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No FTIE in TDLS Teardown"); 8408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 8418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie = (struct wpa_tdls_ftie *) kde.ftie; 8448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Process MIC check to see if TDLS Teardown is right */ 8468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_supplicant_verify_tdls_mic_teardown(4, reason_code, 8478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->dtoken, peer, 8488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) lnkid, ftie) < 0) { 8498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: MIC failure for TDLS " 8508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Teardown Request from " MACSTR, MAC2STR(src_addr)); 8518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 8528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_ftie: 8558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 8568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Request the driver to disable the direct link and clear associated 8578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * keys. 8588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 8598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, src_addr); 8608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* clear the Peerkey statemachine */ 8628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_peer_free(sm, peer); 8638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 8658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 8698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_tdls_send_error - To send suitable TDLS status response with 8708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * appropriate status code mentioning reason for error/failure. 8718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @dst - MAC addr of Peer station 8728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @tdls_action - TDLS frame type for which error code is sent 8738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @status - status code mentioning reason 8748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 8758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_send_error(struct wpa_sm *sm, const u8 *dst, 8778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 tdls_action, u8 dialog_token, u16 status) 8788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Sending error to " MACSTR 8808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " (action=%u status=%u)", 8818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(dst), tdls_action, status); 8828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return wpa_tdls_tpk_send(sm, dst, tdls_action, dialog_token, status, 8838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL, 0); 8848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8871f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic struct wpa_tdls_peer * 8884b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidtwpa_tdls_add_peer(struct wpa_sm *sm, const u8 *addr, int *existing) 8891f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 8901f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt struct wpa_tdls_peer *peer; 8911f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 8924b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt if (existing) 8934b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt *existing = 0; 8944b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt for (peer = sm->tdls; peer; peer = peer->next) { 8954b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt if (os_memcmp(peer->addr, addr, ETH_ALEN) == 0) { 8964b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt if (existing) 8974b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt *existing = 1; 8984b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt return peer; /* re-use existing entry */ 8994b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt } 9004b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt } 9014b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt 9021f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Creating peer entry for " MACSTR, 9031f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt MAC2STR(addr)); 9041f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 9051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt peer = os_zalloc(sizeof(*peer)); 9061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (peer == NULL) 9071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return NULL; 9081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 9091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt os_memcpy(peer->addr, addr, ETH_ALEN); 9101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt peer->next = sm->tdls; 9111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt sm->tdls = peer; 9121f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 9131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return peer; 9141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 9151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 9161f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 9178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_send_tpk_m1(struct wpa_sm *sm, 9188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer) 9198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t buf_len; 9218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_timeoutie timeoutie; 9228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 rsn_capab; 9238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *ftie; 9248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *rbuf, *pos, *count_pos; 9258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 count; 9268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct rsn_ie_hdr *hdr; 9278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!wpa_tdls_get_privacy(sm)) { 9298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: No security used on the link"); 9308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_i_len = 0; 9318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_rsnie; 9328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 9358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * TPK Handshake Message 1: 9368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * FTIE: ANonce=0, SNonce=initiator nonce MIC=0, DataKDs=(RSNIE_I, 9378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Timeout Interval IE)) 9388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 9398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Filling RSN IE */ 9418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr = (struct rsn_ie_hdr *) peer->rsnie_i; 9428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr->elem_id = WLAN_EID_RSN; 9438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(hdr->version, RSN_VERSION); 9448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = (u8 *) (hdr + 1); 9468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt RSN_SELECTOR_PUT(pos, RSN_CIPHER_SUITE_NO_GROUP_ADDRESSED); 9478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += RSN_SELECTOR_LEN; 9488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt count_pos = pos; 9498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 9508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt count = 0; 9528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 9548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * AES-CCMP is the default Encryption preferred for TDLS, so 9558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * RSN IE is filled only with CCMP CIPHER 9568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Note: TKIP is not used to encrypt TDLS link. 9578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 9588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Regardless of the cipher used on the AP connection, select CCMP 9598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * here. 9608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 9618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt RSN_SELECTOR_PUT(pos, RSN_CIPHER_SUITE_CCMP); 9628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += RSN_SELECTOR_LEN; 9638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt count++; 9648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(count_pos, count); 9668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(pos, 1); 9688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 9698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt RSN_SELECTOR_PUT(pos, RSN_AUTH_KEY_MGMT_TPK_HANDSHAKE); 9708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += RSN_SELECTOR_LEN; 9718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rsn_capab = WPA_CAPABILITY_PEERKEY_ENABLED; 9738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rsn_capab |= RSN_NUM_REPLAY_COUNTERS_16 << 2; 9748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 9758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_ALT_RSN_IE) { 9768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Use alternative RSN IE for " 9778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "testing"); 9788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rsn_capab = WPA_CAPABILITY_PEERKEY_ENABLED; 9798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 9818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(pos, rsn_capab); 9828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 9838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 9848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_ALT_RSN_IE) { 9858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Number of PMKIDs */ 9868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 0x00; 9878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 0x00; 9888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 9908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr->len = (pos - peer->rsnie_i) - 2; 9928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_i_len = pos - peer->rsnie_i; 9938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: RSN IE for TPK handshake", 9948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_i, peer->rsnie_i_len); 9958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_rsnie: 9978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len = 0; 9988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_tdls_get_privacy(sm)) 9998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len += peer->rsnie_i_len + sizeof(struct wpa_tdls_ftie) + 10008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct wpa_tdls_timeoutie); 10018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 10028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_tdls_get_privacy(sm) && 10038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (tdls_testing & TDLS_TESTING_LONG_FRAME)) 10048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len += 170; 10058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_DIFF_BSSID) 10068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len += sizeof(struct wpa_tdls_lnkid); 10078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 10088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rbuf = os_zalloc(buf_len + 1); 10098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (rbuf == NULL) { 10108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_peer_free(sm, peer); 10118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = rbuf; 10148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!wpa_tdls_get_privacy(sm)) 10168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_ies; 10178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Initiator RSN IE */ 10198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = wpa_add_ie(pos, peer->rsnie_i, peer->rsnie_i_len); 10208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie = (struct wpa_tdls_ftie *) pos; 10228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_type = WLAN_EID_FAST_BSS_TRANSITION; 10238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_len = sizeof(struct wpa_tdls_ftie) - 2; 10248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_get_random(peer->inonce, WPA_NONCE_LEN)) { 10268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_msg(sm->ctx->msg_ctx, MSG_WARNING, 10278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TDLS: Failed to get random data for initiator Nonce"); 10288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(rbuf); 10298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_peer_free(sm, peer); 10308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Initiator Nonce for TPK handshake", 10338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->inonce, WPA_NONCE_LEN); 10348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ftie->Snonce, peer->inonce, WPA_NONCE_LEN); 10358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: FTIE for TPK Handshake M1", 10378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) ftie, sizeof(struct wpa_tdls_ftie)); 10388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = (u8 *) (ftie + 1); 10408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 10428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_LONG_FRAME) { 10438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - add extra subelem to " 10448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "FTIE"); 10458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_len += 170; 10468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 255; /* FTIE subelem */ 10478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 168; /* FTIE subelem length */ 10488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 168; 10498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 10518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Lifetime */ 10538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->lifetime = TPK_LIFETIME; 10548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 10558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_SHORT_LIFETIME) { 10568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - use short TPK " 10578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "lifetime"); 10588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->lifetime = 301; 10598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_LONG_LIFETIME) { 10618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - use long TPK " 10628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "lifetime"); 10638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->lifetime = 0xffffffff; 10648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 10668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = wpa_add_tdls_timeoutie(pos, (u8 *) &timeoutie, 10678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(timeoutie), peer->lifetime); 10688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK lifetime %u seconds", peer->lifetime); 10698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_ies: 10718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 10738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_DIFF_BSSID) { 10748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - use incorrect BSSID in " 10758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Link Identifier"); 10768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_lnkid *l = (struct wpa_tdls_lnkid *) pos; 10778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_linkid(sm, peer, l); 10788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l->bssid[5] ^= 0x01; 10798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += sizeof(*l); 10808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 10828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Sending TDLS Setup Request / TPK " 10848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Handshake Message 1 (peer " MACSTR ")", 10858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(peer->addr)); 10868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10871f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_tdls_tpk_send(sm, peer->addr, WLAN_TDLS_SETUP_REQUEST, 1, 0, 10888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rbuf, pos - rbuf); 10898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(rbuf); 10908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 10928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_send_tpk_m2(struct wpa_sm *sm, 10968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const unsigned char *src_addr, u8 dtoken, 10978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_lnkid *lnkid, 10988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpa_tdls_peer *peer) 10998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *rbuf, *pos; 11018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t buf_len; 11028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 lifetime; 11038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_timeoutie timeoutie; 11048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *ftie; 11058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len = 0; 11078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_tdls_get_privacy(sm)) { 11088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Peer RSN IE, FTIE(Initiator Nonce, Responder Nonce), 11098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Lifetime */ 11108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len += peer->rsnie_i_len + sizeof(struct wpa_tdls_ftie) + 11118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct wpa_tdls_timeoutie); 11128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 11138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_LONG_FRAME) 11148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len += 170; 11158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 11168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rbuf = os_zalloc(buf_len + 1); 11198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (rbuf == NULL) 11208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 11218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = rbuf; 11228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!wpa_tdls_get_privacy(sm)) 11248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_ies; 11258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Peer RSN IE */ 11278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = wpa_add_ie(pos, peer->rsnie_p, peer->rsnie_p_len); 11288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie = (struct wpa_tdls_ftie *) pos; 11308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_type = WLAN_EID_FAST_BSS_TRANSITION; 11318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO: ftie->mic_control to set 2-RESPONSE */ 11328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ftie->Anonce, peer->rnonce, WPA_NONCE_LEN); 11338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ftie->Snonce, peer->inonce, WPA_NONCE_LEN); 11348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_len = sizeof(struct wpa_tdls_ftie) - 2; 11358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: FTIE for TPK M2", 11368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) ftie, sizeof(*ftie)); 11378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = (u8 *) (ftie + 1); 11398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 11418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_LONG_FRAME) { 11428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - add extra subelem to " 11438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "FTIE"); 11448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_len += 170; 11458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 255; /* FTIE subelem */ 11468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 168; /* FTIE subelem length */ 11478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 168; 11488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 11508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Lifetime */ 11528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime = peer->lifetime; 11538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 11548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_WRONG_LIFETIME_RESP) { 11558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - use wrong TPK " 11568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "lifetime in response"); 11578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime++; 11588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 11608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = wpa_add_tdls_timeoutie(pos, (u8 *) &timeoutie, 11618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(timeoutie), lifetime); 11628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK lifetime %u seconds from initiator", 11638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime); 11648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* compute MIC before sending */ 11668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_ftie_mic(peer->tpk.kck, 2, (u8 *) lnkid, peer->rsnie_p, 11678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) &timeoutie, (u8 *) ftie, ftie->mic); 11688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_ies: 11708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_tpk_send(sm, src_addr, WLAN_TDLS_SETUP_RESPONSE, dtoken, 0, 11718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rbuf, pos - rbuf); 11728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(rbuf); 11738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 11758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_send_tpk_m3(struct wpa_sm *sm, 11798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const unsigned char *src_addr, u8 dtoken, 11808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_lnkid *lnkid, 11818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpa_tdls_peer *peer) 11828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *rbuf, *pos; 11848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t buf_len; 11858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *ftie; 11868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_timeoutie timeoutie; 11878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 lifetime; 11888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len = 0; 11908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_tdls_get_privacy(sm)) { 11918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Peer RSN IE, FTIE(Initiator Nonce, Responder Nonce), 11928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Lifetime */ 11938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len += peer->rsnie_i_len + sizeof(struct wpa_tdls_ftie) + 11948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct wpa_tdls_timeoutie); 11958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 11968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_LONG_FRAME) 11978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf_len += 170; 11988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 11998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rbuf = os_zalloc(buf_len + 1); 12028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (rbuf == NULL) 12038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 12048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = rbuf; 12058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!wpa_tdls_get_privacy(sm)) 12078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_ies; 12088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Peer RSN IE */ 12108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = wpa_add_ie(pos, peer->rsnie_p, peer->rsnie_p_len); 12118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie = (struct wpa_tdls_ftie *) pos; 12138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_type = WLAN_EID_FAST_BSS_TRANSITION; 12148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /*TODO: ftie->mic_control to set 3-CONFIRM */ 12158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ftie->Anonce, peer->rnonce, WPA_NONCE_LEN); 12168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ftie->Snonce, peer->inonce, WPA_NONCE_LEN); 12178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_len = sizeof(struct wpa_tdls_ftie) - 2; 12188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = (u8 *) (ftie + 1); 12208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 12228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_LONG_FRAME) { 12238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - add extra subelem to " 12248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "FTIE"); 12258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie->ie_len += 170; 12268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 255; /* FTIE subelem */ 12278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = 168; /* FTIE subelem length */ 12288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 168; 12298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 12318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Lifetime */ 12338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime = peer->lifetime; 12348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 12358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_WRONG_LIFETIME_CONF) { 12368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - use wrong TPK " 12378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "lifetime in confirm"); 12388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime++; 12398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 12418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = wpa_add_tdls_timeoutie(pos, (u8 *) &timeoutie, 12428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(timeoutie), lifetime); 12438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK lifetime %u seconds", 12448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime); 12458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* compute MIC before sending */ 12478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_ftie_mic(peer->tpk.kck, 3, (u8 *) lnkid, peer->rsnie_p, 12488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) &timeoutie, (u8 *) ftie, ftie->mic); 12498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_ies: 12518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_tpk_send(sm, src_addr, WLAN_TDLS_SETUP_CONFIRM, dtoken, 0, 12528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rbuf, pos - rbuf); 12538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(rbuf); 12548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 12568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12591f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int wpa_tdls_send_discovery_response(struct wpa_sm *sm, 12601f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt struct wpa_tdls_peer *peer, 12611f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt u8 dialog_token) 12621f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 12631f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Sending TDLS Discovery Response " 12641f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "(peer " MACSTR ")", MAC2STR(peer->addr)); 12651f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 12661f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return wpa_tdls_tpk_send(sm, peer->addr, WLAN_TDLS_DISCOVERY_RESPONSE, 12671f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt dialog_token, 0, NULL, 0); 12681f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 12691f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 12701f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 12711f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int 12721f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtwpa_tdls_process_discovery_request(struct wpa_sm *sm, const u8 *addr, 12731f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt const u8 *buf, size_t len) 12741f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 12751f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt struct wpa_eapol_ie_parse kde; 12761f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt const struct wpa_tdls_lnkid *lnkid; 12771f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt struct wpa_tdls_peer *peer; 12781f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt size_t min_req_len = sizeof(struct wpa_tdls_frame) + 12791f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1 /* dialog token */ + sizeof(struct wpa_tdls_lnkid); 12801f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt u8 dialog_token; 12811f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 12821f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Discovery Request from " MACSTR, 12831f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt MAC2STR(addr)); 12841f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 12851f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (len < min_req_len) { 12861f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS Discovery Request is too short: " 12871f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "%d", (int) len); 12881f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 12891f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 12901f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 12911f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt dialog_token = buf[sizeof(struct wpa_tdls_frame)]; 12921f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 12931f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (wpa_supplicant_parse_ies(buf + sizeof(struct wpa_tdls_frame) + 1, 12941f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt len - (sizeof(struct wpa_tdls_frame) + 1), 12951f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt &kde) < 0) 12961f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 12971f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 12981f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (!kde.lnkid) { 12991f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Link ID not found in Discovery " 13001f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "Request"); 13011f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 13021f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 13031f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13041f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt lnkid = (const struct wpa_tdls_lnkid *) kde.lnkid; 13051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (os_memcmp(sm->bssid, lnkid->bssid, ETH_ALEN) != 0) { 13071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Discovery Request from different " 13081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt " BSS " MACSTR, MAC2STR(lnkid->bssid)); 13091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 13101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 13111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13124b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt peer = wpa_tdls_add_peer(sm, addr, NULL); 13131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (peer == NULL) 13141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 13151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13161f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return wpa_tdls_send_discovery_response(sm, peer, dialog_token); 13171f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 13181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13191f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13201f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtint wpa_tdls_send_discovery_request(struct wpa_sm *sm, const u8 *addr) 13211f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 13221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_disabled || !sm->tdls_supported) 13231f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 13241f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13251f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Sending Discovery Request to peer " 13261f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt MACSTR, MAC2STR(addr)); 13271f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return wpa_tdls_tpk_send(sm, addr, WLAN_TDLS_DISCOVERY_REQUEST, 13281f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1, 0, NULL, 0); 13291f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 13301f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13311f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13321f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int copy_supp_rates(const struct wpa_eapol_ie_parse *kde, 13331f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt struct wpa_tdls_peer *peer) 13341f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 13351f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (!kde->supp_rates) { 13361f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: No supported rates received"); 13371f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 13381f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 1339a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt peer->supp_rates_len = merge_byte_arrays( 1340a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt peer->supp_rates, sizeof(peer->supp_rates), 1341a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt kde->supp_rates + 2, kde->supp_rates_len - 2, 1342a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt kde->ext_supp_rates + 2, kde->ext_supp_rates_len - 2); 13431f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return 0; 13441f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 13451f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 13461f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1347f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidtstatic int copy_peer_ht_capab(const struct wpa_eapol_ie_parse *kde, 1348f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt struct wpa_tdls_peer *peer) 1349f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt{ 1350f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (!kde->ht_capabilities || 1351f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt kde->ht_capabilities_len < 1352f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt sizeof(struct ieee80211_ht_capabilities) ) { 1353f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: No supported ht capabilities " 1354f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt "received"); 1355f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt return 0; 1356f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt } 1357f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1358f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (!peer->ht_capabilities) { 1359f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt peer->ht_capabilities = 1360f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt os_zalloc(sizeof(struct ieee80211_ht_capabilities)); 1361f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (peer->ht_capabilities == NULL) 1362f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt return -1; 1363f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt } 1364f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1365f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt os_memcpy(peer->ht_capabilities, kde->ht_capabilities, 1366f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt sizeof(struct ieee80211_ht_capabilities)); 1367f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Peer HT capabilities", 1368f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt (u8 *) peer->ht_capabilities, 1369f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt sizeof(struct ieee80211_ht_capabilities)); 1370f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1371f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt return 0; 1372f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt} 1373f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1374f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 137533e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidtstatic int copy_peer_vht_capab(const struct wpa_eapol_ie_parse *kde, 137633e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt struct wpa_tdls_peer *peer) 137733e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt{ 137833e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt if (!kde->vht_capabilities || 137933e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt kde->vht_capabilities_len < 138033e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt sizeof(struct ieee80211_vht_capabilities) ) { 138133e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: No supported vht capabilities " 138233e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt "received"); 138333e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt return 0; 138433e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt } 138533e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt 138633e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt if (!peer->vht_capabilities) { 138733e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt peer->vht_capabilities = 138833e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt os_zalloc(sizeof(struct ieee80211_vht_capabilities)); 138933e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt if (peer->vht_capabilities == NULL) 139033e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt return -1; 139133e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt } 139233e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt 139333e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt os_memcpy(peer->vht_capabilities, kde->vht_capabilities, 139433e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt sizeof(struct ieee80211_vht_capabilities)); 139533e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Peer VHT capabilities", 139633e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt (u8 *) peer->vht_capabilities, 139733e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt sizeof(struct ieee80211_vht_capabilities)); 139833e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt 139933e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt return 0; 140033e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt} 140133e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt 140233e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt 1403f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidtstatic int copy_peer_ext_capab(const struct wpa_eapol_ie_parse *kde, 1404f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt struct wpa_tdls_peer *peer) 1405f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt{ 1406f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (!kde->ext_capab) { 1407f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: No extended capabilities " 1408f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt "received"); 1409f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt return 0; 1410f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt } 1411f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1412f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (!peer->ext_capab || peer->ext_capab_len < kde->ext_capab_len - 2) { 1413f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt /* Need to allocate buffer to fit the new information */ 1414f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt os_free(peer->ext_capab); 1415f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt peer->ext_capab = os_zalloc(kde->ext_capab_len - 2); 1416f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (peer->ext_capab == NULL) 1417f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt return -1; 1418f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt } 1419f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1420f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt peer->ext_capab_len = kde->ext_capab_len - 2; 1421f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt os_memcpy(peer->ext_capab, kde->ext_capab + 2, peer->ext_capab_len); 1422f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1423f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt return 0; 1424f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt} 1425f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1426f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 14278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_process_tpk_m1(struct wpa_sm *sm, const u8 *src_addr, 14288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *buf, size_t len) 14298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer; 14318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_eapol_ie_parse kde; 14328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_ie_data ie; 14338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int cipher; 14348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *cpos; 14358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *ftie = NULL; 14368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_timeoutie *timeoutie; 14378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_lnkid *lnkid; 14388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 lifetime = 0; 14398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#if 0 14408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct rsn_ie_hdr *hdr; 14418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *pos; 14428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 rsn_capab; 14438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 rsn_ver; 14448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 14458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dtoken; 14468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 ielen; 14478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 status = WLAN_STATUS_UNSPECIFIED_FAILURE; 14488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int tdls_prohibited = sm->tdls_prohibited; 14491f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt int existing_peer = 0; 14508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len < 3 + 3) 14528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 14538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cpos = buf; 14558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cpos += 1 /* pkt_type */ + 1 /* Category */ + 1 /* Action */; 14568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* driver had already verified the frame format */ 14588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dtoken = *cpos++; /* dialog token */ 14598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Dialog Token in TPK M1 %d", dtoken); 14618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14624b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt peer = wpa_tdls_add_peer(sm, src_addr, &existing_peer); 14634b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt if (peer == NULL) 14644b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt goto error; 14651f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 14660ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt /* If found, use existing entry instead of adding a new one; 14670ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * how to handle the case where both ends initiate at the 14680ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * same time? */ 14690ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt if (existing_peer) { 14700ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt if (peer->tpk_success) { 14710ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TDLS Setup Request while " 14720ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt "direct link is enabled - tear down the " 14730ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt "old link first"); 14740ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt#if 0 14750ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt /* TODO: Disabling the link would be more proper 14760ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * operation here, but it seems to trigger a race with 14770ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * some drivers handling the new request frame. */ 14780ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, src_addr); 14790ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt#else 14800ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt if (sm->tdls_external_setup) 14810ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, 14820ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt src_addr); 14830ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt else 14840ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_tdls_del_key(sm, peer); 14850ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt#endif 14860ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_tdls_peer_free(sm, peer); 14870ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt } 14880ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt 14890ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt /* 14900ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * An entry is already present, so check if we already sent a 14910ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * TDLS Setup Request. If so, compare MAC addresses and let the 14920ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * STA with the lower MAC address continue as the initiator. 14930ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * The other negotiation is terminated. 14940ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt */ 14950ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt if (peer->initiator) { 14960ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt if (os_memcmp(sm->own_addr, src_addr, ETH_ALEN) < 0) { 14970ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Discard request " 14980ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt "from peer with higher address " 14990ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt MACSTR, MAC2STR(src_addr)); 15000ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt return -1; 15010ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt } else { 15020ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Accept request " 15030ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt "from peer with lower address " 15040ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt MACSTR " (terminate previously " 15050ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt "initiated negotiation", 15060ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt MAC2STR(src_addr)); 15070ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt if (sm->tdls_external_setup) 15080ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, 15090ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt src_addr); 15100ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt else 15110ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_tdls_del_key(sm, peer); 15120ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_tdls_peer_free(sm, peer); 15130ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt } 15140ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt } 15150ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt } 15160ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt 15171f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* capability information */ 15181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt peer->capability = WPA_GET_LE16(cpos); 15191f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt cpos += 2; 15208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = len - (cpos - buf); /* start of IE in buf */ 15228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_supplicant_parse_ies(cpos, ielen, &kde) < 0) { 15238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Failed to parse IEs in TPK M1"); 15248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 15258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.lnkid == NULL || kde.lnkid_len < 3 * ETH_ALEN) { 15288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No valid Link Identifier IE in " 15298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK M1"); 15308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 15318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Link ID Received from TPK M1", 15338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt kde.lnkid, kde.lnkid_len); 15348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lnkid = (struct wpa_tdls_lnkid *) kde.lnkid; 15358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(sm->bssid, lnkid->bssid, ETH_ALEN) != 0) { 15368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: TPK M1 from diff BSS"); 15378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_NOT_IN_SAME_BSS; 15388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 15398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK M1 - TPK initiator " MACSTR, 15428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(src_addr)); 15438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15441f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (copy_supp_rates(&kde, peer) < 0) 15451f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt goto error; 15461f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1547f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (copy_peer_ht_capab(&kde, peer) < 0) 1548f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt goto error; 1549f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 155033e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt if (copy_peer_vht_capab(&kde, peer) < 0) 155133e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt goto error; 155233e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt 1553f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (copy_peer_ext_capab(&kde, peer) < 0) 1554f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt goto error; 1555f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1556f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt peer->qos_info = kde.qosinfo; 1557f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 155851b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt peer->aid = kde.aid; 155951b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt 15608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 15618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_CONCURRENT_INIT) { 15624b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt peer = wpa_tdls_add_peer(sm, src_addr, NULL); 15634b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt if (peer == NULL) 15644b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt goto error; 15658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing concurrent initiation of " 15668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TDLS setup - send own request"); 15678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->initiator = 1; 15688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_send_tpk_m1(sm, peer); 15698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((tdls_testing & TDLS_TESTING_IGNORE_AP_PROHIBIT) && 15728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt tdls_prohibited) { 15738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - ignore AP prohibition " 15748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "on TDLS"); 15758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt tdls_prohibited = 0; 15768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 15788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_prohibited) { 15808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: TDLS prohibited in this BSS"); 15818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_REQUEST_DECLINED; 15828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 15838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!wpa_tdls_get_privacy(sm)) { 15868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.rsn_ie) { 15878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: RSN IE in TPK M1 while " 15888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "security is disabled"); 15898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_SECURITY_DISABLED; 15908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 15918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_rsn; 15938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.ftie == NULL || kde.ftie_len < sizeof(*ftie) || 15968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt kde.rsn_ie == NULL) { 15978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No FTIE or RSN IE in TPK M1"); 15988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_INVALID_PARAMETERS; 15998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 16008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.rsn_ie_len > TDLS_MAX_IE_LEN) { 16038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Too long Initiator RSN IE in " 16048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK M1"); 16058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_INVALID_RSNIE; 16068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 16078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_parse_wpa_ie_rsn(kde.rsn_ie, kde.rsn_ie_len, &ie) < 0) { 16108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Failed to parse RSN IE in TPK M1"); 16118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_INVALID_RSNIE; 16128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 16138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = ie.pairwise_cipher; 16168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cipher & WPA_CIPHER_CCMP) { 16178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Using CCMP for direct link"); 16188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = WPA_CIPHER_CCMP; 16198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 16208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No acceptable cipher in TPK M1"); 16218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; 16228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 16238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((ie.capabilities & 16268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (WPA_CAPABILITY_NO_PAIRWISE | WPA_CAPABILITY_PEERKEY_ENABLED)) != 16278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_CAPABILITY_PEERKEY_ENABLED) { 16288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Invalid RSN Capabilities in " 16298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK M1"); 16308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_INVALID_RSN_IE_CAPAB; 16318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 16328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Lifetime */ 16358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.key_lifetime == NULL) { 16368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No Key Lifetime IE in TPK M1"); 16378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_UNACCEPTABLE_LIFETIME; 16388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 16398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt timeoutie = (struct wpa_tdls_timeoutie *) kde.key_lifetime; 16418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime = WPA_GET_LE32(timeoutie->value); 16428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK lifetime %u seconds", lifetime); 16438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (lifetime < 300) { 16448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Too short TPK lifetime"); 16458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_UNACCEPTABLE_LIFETIME; 16468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 16478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_rsn: 16501f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt#ifdef CONFIG_TDLS_TESTING 16511f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (tdls_testing & TDLS_TESTING_CONCURRENT_INIT) { 16521f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (os_memcmp(sm->own_addr, peer->addr, ETH_ALEN) < 0) { 16531f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* 16541f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * The request frame from us is going to win, so do not 16551f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * replace information based on this request frame from 16561f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * the peer. 16571f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt */ 16581f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt goto skip_rsn_check; 16591f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 16601f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 16611f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 16621f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 16638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->initiator = 0; /* Need to check */ 16648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->dtoken = dtoken; 16658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!wpa_tdls_get_privacy(sm)) { 16678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_i_len = 0; 16688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_p_len = 0; 16698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->cipher = WPA_CIPHER_NONE; 16708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_rsn_check; 16718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie = (struct wpa_tdls_ftie *) kde.ftie; 16748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(peer->inonce, ftie->Snonce, WPA_NONCE_LEN); 16758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(peer->rsnie_i, kde.rsn_ie, kde.rsn_ie_len); 16768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_i_len = kde.rsn_ie_len; 16778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->cipher = cipher; 16788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_get_random(peer->rnonce, WPA_NONCE_LEN)) { 16808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_msg(sm->ctx->ctx, MSG_WARNING, 16818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TDLS: Failed to get random data for responder nonce"); 16828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_peer_free(sm, peer); 16838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 16848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#if 0 16878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* get version info from RSNIE received from Peer */ 16888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr = (struct rsn_ie_hdr *) kde.rsn_ie; 16898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rsn_ver = WPA_GET_LE16(hdr->version); 16908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* use min(peer's version, out version) */ 16928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (rsn_ver > RSN_VERSION) 16938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rsn_ver = RSN_VERSION; 16948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr = (struct rsn_ie_hdr *) peer->rsnie_p; 16968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr->elem_id = WLAN_EID_RSN; 16988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(hdr->version, rsn_ver); 16998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = (u8 *) (hdr + 1); 17008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt RSN_SELECTOR_PUT(pos, RSN_CIPHER_SUITE_NO_GROUP_ADDRESSED); 17028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += RSN_SELECTOR_LEN; 17038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Include only the selected cipher in pairwise cipher suite */ 17048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(pos, 1); 17058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 17068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cipher == WPA_CIPHER_CCMP) 17078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt RSN_SELECTOR_PUT(pos, RSN_CIPHER_SUITE_CCMP); 17088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += RSN_SELECTOR_LEN; 17098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(pos, 1); 17118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 17128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt RSN_SELECTOR_PUT(pos, RSN_AUTH_KEY_MGMT_TPK_HANDSHAKE); 17138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += RSN_SELECTOR_LEN; 17148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rsn_capab = WPA_CAPABILITY_PEERKEY_ENABLED; 17168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rsn_capab |= RSN_NUM_REPLAY_COUNTERS_16 << 2; 17178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE16(pos, rsn_capab); 17188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 17198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr->len = (pos - peer->rsnie_p) - 2; 17218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_p_len = pos - peer->rsnie_p; 17228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 17238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* temp fix: validation of RSNIE later */ 17258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(peer->rsnie_p, peer->rsnie_i, peer->rsnie_i_len); 17268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_p_len = peer->rsnie_i_len; 17278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: RSN IE for TPK handshake", 17298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_p, peer->rsnie_p_len); 17308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->lifetime = lifetime; 17328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_generate_tpk(peer, sm->own_addr, sm->bssid); 17348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_rsn_check: 17361f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* add the peer to the driver as a "setup in progress" peer */ 173751b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt wpa_sm_tdls_peer_addset(sm, peer->addr, 1, 0, 0, NULL, 0, NULL, NULL, 0, 1738f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt NULL, 0); 17391f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 17408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Sending TDLS Setup Response / TPK M2"); 17411f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (wpa_tdls_send_tpk_m2(sm, src_addr, dtoken, lnkid, peer) < 0) { 17421f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_tdls_disable_link(sm, peer->addr); 17431f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt goto error; 17441f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 17458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 17478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidterror: 17498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_send_error(sm, src_addr, WLAN_TDLS_SETUP_RESPONSE, dtoken, 17508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status); 17518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 17528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17558da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidtstatic int wpa_tdls_enable_link(struct wpa_sm *sm, struct wpa_tdls_peer *peer) 17568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->tpk_success = 1; 17588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_tdls_tpk_timeout, sm, peer); 17598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_tdls_get_privacy(sm)) { 17608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 lifetime = peer->lifetime; 17618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 17628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Start the initiator process a bit earlier to avoid race 17638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * condition with the responder sending teardown request. 17648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 17658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (lifetime > 3 && peer->initiator) 17668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime -= 3; 17678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(lifetime, 0, wpa_tdls_tpk_timeout, 17688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sm, peer); 17698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 17708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_NO_TPK_EXPIRATION) { 17718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - disable TPK " 17728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "expiration"); 17738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_tdls_tpk_timeout, sm, peer); 17748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 17768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17771f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1778f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt /* add supported rates, capabilities, and qos_info to the TDLS peer */ 177951b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt if (wpa_sm_tdls_peer_addset(sm, peer->addr, 0, peer->aid, 178051b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt peer->capability, 17818da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt peer->supp_rates, peer->supp_rates_len, 17828da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt peer->ht_capabilities, 17838da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt peer->vht_capabilities, 17848da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt peer->qos_info, peer->ext_capab, 17858da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt peer->ext_capab_len) < 0) 17868da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt return -1; 17871f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 17888da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt if (peer->reconfig_key && wpa_tdls_set_key(sm, peer) < 0) { 17898da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Could not configure key to the " 17908da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt "driver"); 17918da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt return -1; 17928da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt } 17938da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt peer->reconfig_key = 0; 17948da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt 17958da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt return wpa_sm_tdls_oper(sm, TDLS_ENABLE_LINK, peer->addr); 17968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_process_tpk_m2(struct wpa_sm *sm, const u8 *src_addr, 18008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *buf, size_t len) 18018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 18028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer; 18038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_eapol_ie_parse kde; 18048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_ie_data ie; 18058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int cipher; 18068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *ftie; 18078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_timeoutie *timeoutie; 18088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_lnkid *lnkid; 18098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 lifetime; 18108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 dtoken; 18118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ielen; 18128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 status; 18138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *pos; 18148da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt int ret; 18158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Received TDLS Setup Response / TPK M2 " 18178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(Peer " MACSTR ")", MAC2STR(src_addr)); 18188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (peer = sm->tdls; peer; peer = peer->next) { 18198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(peer->addr, src_addr, ETH_ALEN) == 0) 18208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 18218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer == NULL) { 18238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No matching peer found for " 18248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK M2: " MACSTR, MAC2STR(src_addr)); 18258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18270ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt if (!peer->initiator) { 18280ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt /* 18290ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * This may happen if both devices try to initiate TDLS at the 18300ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * same time and we accept the TPK M1 from the peer in 18310ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt * wpa_tdls_process_tpk_m1() and clear our previous state. 18320ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt */ 18330ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt wpa_printf(MSG_INFO, "TDLS: We were not the initiator, so " 18340ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt "ignore TPK M2 from " MACSTR, MAC2STR(src_addr)); 18350ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt return -1; 18360ccb66edb8d2a0a397320ace3ec2a03fb0d00d5fDmitry Shmidt } 18378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_tpk_retry_timeout_cancel(sm, peer, WLAN_TDLS_SETUP_REQUEST); 18388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len < 3 + 2 + 1) 18408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = buf; 18428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 1 /* pkt_type */ + 1 /* Category */ + 1 /* Action */; 18438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WPA_GET_LE16(pos); 18448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2 /* status code */; 18458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (status != WLAN_STATUS_SUCCESS) { 18478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Status code in TPK M2: %u", 18488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status); 18491f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_external_setup) 18501f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, src_addr); 18518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_UNSPECIFIED_FAILURE; 18558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO: need to verify dialog token matches here or in kernel */ 18578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dtoken = *pos++; /* dialog token */ 18588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Dialog Token in TPK M2 %d", dtoken); 18608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len < 3 + 2 + 1 + 2) 18628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 18631f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 18641f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* capability information */ 18651f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt peer->capability = WPA_GET_LE16(pos); 18661f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt pos += 2; 18678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = len - (pos - buf); /* start of IE in buf */ 18698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_supplicant_parse_ies(pos, ielen, &kde) < 0) { 18708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Failed to parse IEs in TPK M2"); 18718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 18728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 18758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_testing & TDLS_TESTING_DECLINE_RESP) { 18768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - decline response"); 18778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_REQUEST_DECLINED; 18788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 18798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 18818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.lnkid == NULL || kde.lnkid_len < 3 * ETH_ALEN) { 18838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No valid Link Identifier IE in " 18848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK M2"); 18858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 18868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Link ID Received from TPK M2", 18888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt kde.lnkid, kde.lnkid_len); 18898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lnkid = (struct wpa_tdls_lnkid *) kde.lnkid; 18908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(sm->bssid, lnkid->bssid, ETH_ALEN) != 0) { 18928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: TPK M2 from different BSS"); 18938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_NOT_IN_SAME_BSS; 18948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 18958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18971f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (copy_supp_rates(&kde, peer) < 0) 18981f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt goto error; 18991f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1900f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (copy_peer_ht_capab(&kde, peer) < 0) 1901f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt goto error; 1902f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 190333e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt if (copy_peer_vht_capab(&kde, peer) < 0) 190433e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt goto error; 190533e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt 1906f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (copy_peer_ext_capab(&kde, peer) < 0) 1907f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt goto error; 1908f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 1909f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt peer->qos_info = kde.qosinfo; 1910f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 191151b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt peer->aid = kde.aid; 191251b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt 19138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!wpa_tdls_get_privacy(sm)) { 19148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_p_len = 0; 19158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->cipher = WPA_CIPHER_NONE; 19168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_rsn; 19178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.ftie == NULL || kde.ftie_len < sizeof(*ftie) || 19208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt kde.rsn_ie == NULL) { 19218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No FTIE or RSN IE in TPK M2"); 19228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_INVALID_PARAMETERS; 19238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 19248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: RSN IE Received from TPK M2", 19268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt kde.rsn_ie, kde.rsn_ie_len); 19278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 19298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * FIX: bitwise comparison of RSN IE is not the correct way of 19308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * validation this. It can be different, but certain fields must 19318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * match. Since we list only a single pairwise cipher in TPK M1, the 19328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * memcmp is likely to work in most cases, though. 19338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 19348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.rsn_ie_len != peer->rsnie_i_len || 19358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcmp(peer->rsnie_i, kde.rsn_ie, peer->rsnie_i_len) != 0) { 19368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: RSN IE in TPK M2 does " 19378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "not match with RSN IE used in TPK M1"); 19388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: RSN IE Sent in TPK M1", 19398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_i, peer->rsnie_i_len); 19408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: RSN IE Received from TPK M2", 19418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt kde.rsn_ie, kde.rsn_ie_len); 19428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_INVALID_RSNIE; 19438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 19448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_parse_wpa_ie_rsn(kde.rsn_ie, kde.rsn_ie_len, &ie) < 0) { 19478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Failed to parse RSN IE in TPK M2"); 19488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_INVALID_RSNIE; 19498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 19508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = ie.pairwise_cipher; 19538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cipher == WPA_CIPHER_CCMP) { 19548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Using CCMP for direct link"); 19558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = WPA_CIPHER_CCMP; 19568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 19578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No acceptable cipher in TPK M2"); 19588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; 19598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 19608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: FTIE Received from TPK M2", 19638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt kde.ftie, sizeof(*ftie)); 19648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie = (struct wpa_tdls_ftie *) kde.ftie; 19658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!os_memcmp(peer->inonce, ftie->Snonce, WPA_NONCE_LEN) == 0) { 19678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: FTIE SNonce in TPK M2 does " 19688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "not match with FTIE SNonce used in TPK M1"); 19698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Silently discard the frame */ 19708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 19718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Responder Nonce and RSN IE */ 19748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(peer->rnonce, ftie->Anonce, WPA_NONCE_LEN); 19758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(peer->rsnie_p, kde.rsn_ie, kde.rsn_ie_len); 19768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->rsnie_p_len = kde.rsn_ie_len; 19778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->cipher = cipher; 19788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Lifetime */ 19808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.key_lifetime == NULL) { 19818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No Key Lifetime IE in TPK M2"); 19828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_UNACCEPTABLE_LIFETIME; 19838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 19848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt timeoutie = (struct wpa_tdls_timeoutie *) kde.key_lifetime; 19868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime = WPA_GET_LE32(timeoutie->value); 19878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK lifetime %u seconds in TPK M2", 19888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime); 19898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (lifetime != peer->lifetime) { 19908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Unexpected TPK lifetime %u in " 19918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK M2 (expected %u)", lifetime, peer->lifetime); 19928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WLAN_STATUS_UNACCEPTABLE_LIFETIME; 19938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto error; 19948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_generate_tpk(peer, sm->own_addr, sm->bssid); 19978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Process MIC check to see if TPK M2 is right */ 19998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_supplicant_verify_tdls_mic(2, peer, (u8 *) lnkid, 20008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) timeoutie, ftie) < 0) { 20018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Discard the frame */ 20028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_del_key(sm, peer); 20038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_peer_free(sm, peer); 20041f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_external_setup) 20051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, src_addr); 20068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 20078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20098da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt if (wpa_tdls_set_key(sm, peer) < 0) { 20108da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt /* 20118da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt * Some drivers may not be able to config the key prior to full 20128da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt * STA entry having been configured. 20138da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt */ 20148da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Try to configure TPK again after " 20158da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt "STA entry is complete"); 20168da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt peer->reconfig_key = 1; 20178da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt } 20188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_rsn: 20208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->dtoken = dtoken; 20218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Sending TDLS Setup Confirm / " 20238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK Handshake Message 3"); 20248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_send_tpk_m3(sm, src_addr, dtoken, lnkid, peer); 20258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20268da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt ret = wpa_tdls_enable_link(sm, peer); 20278da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt if (ret < 0) { 20288da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Could not enable link"); 20298da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt wpa_tdls_do_teardown(sm, peer, 20308da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt WLAN_REASON_TDLS_TEARDOWN_UNSPECIFIED, 1); 20318da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt } 20328da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt return ret; 20338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidterror: 20358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_send_error(sm, src_addr, WLAN_TDLS_SETUP_CONFIRM, dtoken, 20368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status); 20371f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_external_setup) 20381f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, src_addr); 20398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 20408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 20418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_process_tpk_m3(struct wpa_sm *sm, const u8 *src_addr, 20448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *buf, size_t len) 20458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 20468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer; 20478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_eapol_ie_parse kde; 20488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_ftie *ftie; 20498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_timeoutie *timeoutie; 20508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_lnkid *lnkid; 20518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ielen; 20528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 status; 20538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *pos; 20548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 lifetime; 20558da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt int ret; 20568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Received TDLS Setup Confirm / TPK M3 " 20588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(Peer " MACSTR ")", MAC2STR(src_addr)); 20598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (peer = sm->tdls; peer; peer = peer->next) { 20608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(peer->addr, src_addr, ETH_ALEN) == 0) 20618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 20628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer == NULL) { 20648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No matching peer found for " 20658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK M3: " MACSTR, MAC2STR(src_addr)); 20668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 20678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_tpk_retry_timeout_cancel(sm, peer, WLAN_TDLS_SETUP_RESPONSE); 20698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len < 3 + 3) 20718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 20728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = buf; 20738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 1 /* pkt_type */ + 1 /* Category */ + 1 /* Action */; 20748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = WPA_GET_LE16(pos); 20768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (status != 0) { 20788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Status code in TPK M3: %u", 20798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status); 20801f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_external_setup) 20811f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, src_addr); 20828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 20838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2 /* status code */ + 1 /* dialog token */; 20858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = len - (pos - buf); /* start of IE in buf */ 20878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_supplicant_parse_ies((const u8 *) pos, ielen, &kde) < 0) { 20888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Failed to parse KDEs in TPK M3"); 20898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 20908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.lnkid == NULL || kde.lnkid_len < 3 * ETH_ALEN) { 20938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No Link Identifier IE in TPK M3"); 20948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 20958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Link ID Received from TPK M3", 20978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) kde.lnkid, kde.lnkid_len); 20988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lnkid = (struct wpa_tdls_lnkid *) kde.lnkid; 20998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(sm->bssid, lnkid->bssid, ETH_ALEN) != 0) { 21018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: TPK M3 from diff BSS"); 21028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 21038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!wpa_tdls_get_privacy(sm)) 21068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto skip_rsn; 21078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.ftie == NULL || kde.ftie_len < sizeof(*ftie)) { 21098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No FTIE in TPK M3"); 21108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 21118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: FTIE Received from TPK M3", 21138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt kde.ftie, sizeof(*ftie)); 21148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ftie = (struct wpa_tdls_ftie *) kde.ftie; 21158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.rsn_ie == NULL) { 21178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No RSN IE in TPK M3"); 21188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 21198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: RSN IE Received from TPK M3", 21218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt kde.rsn_ie, kde.rsn_ie_len); 21228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.rsn_ie_len != peer->rsnie_p_len || 21238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcmp(kde.rsn_ie, peer->rsnie_p, peer->rsnie_p_len) != 0) { 21248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: RSN IE in TPK M3 does not match " 21258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with the one sent in TPK M2"); 21268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 21278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!os_memcmp(peer->rnonce, ftie->Anonce, WPA_NONCE_LEN) == 0) { 21308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: FTIE ANonce in TPK M3 does " 21318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "not match with FTIE ANonce used in TPK M2"); 21328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 21338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!os_memcmp(peer->inonce, ftie->Snonce, WPA_NONCE_LEN) == 0) { 21368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: FTIE SNonce in TPK M3 does not " 21378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "match with FTIE SNonce used in TPK M1"); 21388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 21398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (kde.key_lifetime == NULL) { 21428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: No Key Lifetime IE in TPK M3"); 21438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 21448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt timeoutie = (struct wpa_tdls_timeoutie *) kde.key_lifetime; 21468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Timeout IE Received from TPK M3", 21478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) timeoutie, sizeof(*timeoutie)); 21488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime = WPA_GET_LE32(timeoutie->value); 21498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TPK lifetime %u seconds in TPK M3", 21508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime); 21518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (lifetime != peer->lifetime) { 21528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Unexpected TPK lifetime %u in " 21538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "TPK M3 (expected %u)", lifetime, peer->lifetime); 21541f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_external_setup) 21551f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, src_addr); 21568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 21578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_supplicant_verify_tdls_mic(3, peer, (u8 *) lnkid, 21608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) timeoutie, ftie) < 0) { 21618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_del_key(sm, peer); 21628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_peer_free(sm, peer); 21638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 21648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21668da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt if (wpa_tdls_set_key(sm, peer) < 0) { 21678da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt /* 21688da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt * Some drivers may not be able to config the key prior to full 21698da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt * STA entry having been configured. 21708da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt */ 21718da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Try to configure TPK again after " 21728da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt "STA entry is complete"); 21738da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt peer->reconfig_key = 1; 21748da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt } 21758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtskip_rsn: 21778da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt ret = wpa_tdls_enable_link(sm, peer); 21788da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt if (ret < 0) { 21798da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Could not enable link"); 21808da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt wpa_tdls_do_teardown(sm, peer, 21818da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt WLAN_REASON_TDLS_TEARDOWN_UNSPECIFIED, 1); 21828da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt } 21838da800a193fb6f8832218715f82a7b4e2d2ad338Dmitry Shmidt return ret; 21848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 21858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic u8 * wpa_add_tdls_timeoutie(u8 *pos, u8 *ie, size_t ie_len, u32 tsecs) 21888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 21898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_timeoutie *lifetime = (struct wpa_tdls_timeoutie *) ie; 21908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(lifetime, 0, ie_len); 21928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime->ie_type = WLAN_EID_TIMEOUT_INTERVAL; 21938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime->ie_len = sizeof(struct wpa_tdls_timeoutie) - 2; 21948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt lifetime->interval_type = WLAN_TIMEOUT_KEY_LIFETIME; 21958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_LE32(lifetime->value, tsecs); 21968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(pos, ie, ie_len); 21978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return pos + ie_len; 21988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 21998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 22028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_tdls_start - Initiate TDLS handshake (send TPK Handshake Message 1) 22038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @sm: Pointer to WPA state machine data from wpa_sm_init() 22048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @peer: MAC address of the peer STA 22058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: 0 on success, or -1 on failure 22068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 22078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Send TPK Handshake Message 1 info to driver to start TDLS 22088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * handshake with the peer. 22098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 22108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wpa_tdls_start(struct wpa_sm *sm, const u8 *addr) 22118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 22128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer; 22138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int tdls_prohibited = sm->tdls_prohibited; 22148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_disabled || !sm->tdls_supported) 22168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 22178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_TDLS_TESTING 22198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((tdls_testing & TDLS_TESTING_IGNORE_AP_PROHIBIT) && 22208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt tdls_prohibited) { 22218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Testing - ignore AP prohibition " 22228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "on TDLS"); 22238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt tdls_prohibited = 0; 22248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 22258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_TDLS_TESTING */ 22268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tdls_prohibited) { 22288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TDLS is prohibited in this BSS - " 22298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "reject request to start setup"); 22308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 22318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 22328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22334b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt peer = wpa_tdls_add_peer(sm, addr, NULL); 22344b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt if (peer == NULL) 22354b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt return -1; 22368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer->initiator = 1; 22388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22391f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* add the peer to the driver as a "setup in progress" peer */ 224051b6ea882f234c14cd1fe1332a3840cf61fafccaDmitry Shmidt wpa_sm_tdls_peer_addset(sm, peer->addr, 1, 0, 0, NULL, 0, NULL, NULL, 0, 2241f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt NULL, 0); 22421f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 22431f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (wpa_tdls_send_tpk_m1(sm, peer) < 0) { 22441f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_tdls_disable_link(sm, peer->addr); 22451f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 22461f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 22471f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 22481f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return 0; 22498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 22508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22524b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidtvoid wpa_tdls_remove(struct wpa_sm *sm, const u8 *addr) 22538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 22548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer; 22558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22561f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_disabled || !sm->tdls_supported) 22574b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt return; 22588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (peer = sm->tdls; peer; peer = peer->next) { 22608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(peer->addr, addr, ETH_ALEN) == 0) 22618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 22628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 22638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (peer == NULL || !peer->tpk_success) 22654b9d52f502481b258fec743c03a5e957e5605afcDmitry Shmidt return; 22668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22671f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_external_setup) { 22681f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* 22691f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * Disable previous link to allow renegotiation to be completed 22701f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * on AP path. 22711f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt */ 22721f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, peer->addr); 22731f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 22748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 22758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 22788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_supplicant_rx_tdls - Receive TDLS data frame 22798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 22808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function is called to receive TDLS (ethertype = 0x890d) data frames. 22818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 22828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_supplicant_rx_tdls(void *ctx, const u8 *src_addr, 22838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *buf, size_t len) 22848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 22858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_sm *sm = ctx; 22868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_frame *tf; 22878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "TDLS: Received Data frame encapsulation", 22898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf, len); 22908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22911f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (sm->tdls_disabled || !sm->tdls_supported) { 22921f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Discard message - TDLS disabled " 22931f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "or unsupported by driver"); 22948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 22958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 22968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(src_addr, sm->own_addr, ETH_ALEN) == 0) { 22988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Discard copy of own message"); 22998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 23008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len < sizeof(*tf)) { 23038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Drop too short frame"); 23048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 23058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Check to make sure its a valid encapsulated TDLS frame */ 23088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt tf = (struct wpa_tdls_frame *) buf; 23098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tf->payloadtype != 2 /* TDLS_RFTYPE */ || 23108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt tf->category != WLAN_ACTION_TDLS) { 23118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "TDLS: Invalid frame - payloadtype=%u " 23128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "category=%u action=%u", 23138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt tf->payloadtype, tf->category, tf->action); 23148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 23158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (tf->action) { 23188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WLAN_TDLS_SETUP_REQUEST: 23198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_process_tpk_m1(sm, src_addr, buf, len); 23208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 23218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WLAN_TDLS_SETUP_RESPONSE: 23228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_process_tpk_m2(sm, src_addr, buf, len); 23238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 23248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WLAN_TDLS_SETUP_CONFIRM: 23258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_process_tpk_m3(sm, src_addr, buf, len); 23268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 23278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WLAN_TDLS_TEARDOWN: 23288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_recv_teardown(sm, src_addr, buf, len); 23298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 23301f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt case WLAN_TDLS_DISCOVERY_REQUEST: 23311f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_tdls_process_discovery_request(sm, src_addr, buf, len); 23321f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt break; 23338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 23348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Kernel code will process remaining frames */ 23358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Ignore TDLS frame action code %u", 23368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt tf->action); 23378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 23388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 23408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 23438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_tdls_init - Initialize driver interface parameters for TDLS 23448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @wpa_s: Pointer to wpa_supplicant data 23458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: 0 on success, -1 on failure 23468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 23478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function is called to initialize driver interface parameters for TDLS. 23488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_drv_init() must have been called before this function to initialize the 23498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * driver interface. 23508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 23518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wpa_tdls_init(struct wpa_sm *sm) 23528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 23538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sm == NULL) 23548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 23558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 235604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sm->l2_tdls = l2_packet_init(sm->bridge_ifname ? sm->bridge_ifname : 235704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sm->ifname, 235804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sm->own_addr, 23598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ETH_P_80211_ENCAP, wpa_supplicant_rx_tdls, 23608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sm, 0); 23618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sm->l2_tdls == NULL) { 23628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "TDLS: Failed to open l2_packet " 23638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "connection"); 23648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 23658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23671f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* 23681f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * Drivers that support TDLS but don't implement the get_capa callback 23691f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * are assumed to perform everything internally 23701f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt */ 23711f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (wpa_sm_tdls_get_capa(sm, &sm->tdls_supported, 23721f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt &sm->tdls_external_setup) < 0) { 23731f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt sm->tdls_supported = 1; 23741f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt sm->tdls_external_setup = 0; 23751f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 23761f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 23771f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TDLS operation%s supported by " 23781f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "driver", sm->tdls_supported ? "" : " not"); 23791f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Driver uses %s link setup", 23801f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt sm->tdls_external_setup ? "external" : "internal"); 23811f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 23828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 23838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 23848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2386f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidtvoid wpa_tdls_teardown_peers(struct wpa_sm *sm) 2387f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt{ 2388f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt struct wpa_tdls_peer *peer; 2389f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 2390f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt peer = sm->tdls; 2391f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 2392f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Tear down peers"); 2393f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 2394f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt while (peer) { 2395f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Tear down peer " MACSTR, 2396f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt MAC2STR(peer->addr)); 2397f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt if (sm->tdls_external_setup) 2398f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt wpa_tdls_send_teardown(sm, peer->addr, 2399f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt WLAN_REASON_DEAUTH_LEAVING); 2400f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt else 2401f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt wpa_sm_tdls_oper(sm, TDLS_TEARDOWN, peer->addr); 2402f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 2403f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt peer = peer->next; 2404f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt } 2405f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt} 2406f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 2407f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt 24088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_tdls_remove_peers(struct wpa_sm *sm) 24098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_tdls_peer *peer, *tmp; 24118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer = sm->tdls; 24138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sm->tdls = NULL; 24148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (peer) { 24168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int res; 24178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt tmp = peer->next; 24188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res = wpa_sm_tdls_oper(sm, TDLS_DISABLE_LINK, peer->addr); 24198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Remove peer " MACSTR " (res=%d)", 24208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(peer->addr), res); 24218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_peer_free(sm, peer); 24228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(peer); 24238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt peer = tmp; 24248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 24258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 24298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_tdls_deinit - Deinitialize driver interface parameters for TDLS 24308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 24318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function is called to recover driver interface parameters for TDLS 24328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * and frees resources allocated for it. 24338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 24348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wpa_tdls_deinit(struct wpa_sm *sm) 24358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sm == NULL) 24378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 24388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sm->l2_tdls) 24408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(sm->l2_tdls); 24418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sm->l2_tdls = NULL; 24428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_remove_peers(sm); 24448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wpa_tdls_assoc(struct wpa_sm *sm) 24488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Remove peers on association"); 24508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_remove_peers(sm); 24518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wpa_tdls_disassoc(struct wpa_sm *sm) 24558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: Remove peers on disassociation"); 24578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_tdls_remove_peers(sm); 24588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_tdls_prohibited(const u8 *ies, size_t len) 24628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_eapol_ie_parse elems; 24648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ies == NULL) 24668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 24678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_supplicant_parse_ies(ies, len, &elems) < 0) 24698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 24708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (elems.ext_capab == NULL || elems.ext_capab_len < 2 + 5) 24728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 24738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* bit 38 - TDLS Prohibited */ 24758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return !!(elems.ext_capab[2 + 4] & 0x40); 24768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wpa_tdls_ap_ies(struct wpa_sm *sm, const u8 *ies, size_t len) 24808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sm->tdls_prohibited = wpa_tdls_prohibited(ies, len); 24828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TDLS is %s in the target BSS", 24838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sm->tdls_prohibited ? "prohibited" : "allowed"); 24848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wpa_tdls_assoc_resp_ies(struct wpa_sm *sm, const u8 *ies, size_t len) 24888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!sm->tdls_prohibited && wpa_tdls_prohibited(ies, len)) { 24908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: TDLS prohibited based on " 24918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(Re)Association Response IEs"); 24928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sm->tdls_prohibited = 1; 24938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 24948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wpa_tdls_enable(struct wpa_sm *sm, int enabled) 24988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "TDLS: %s", enabled ? "enabled" : "disabled"); 25008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sm->tdls_disabled = !enabled; 25018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 25021f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 25031f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 25041f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtint wpa_tdls_is_external_setup(struct wpa_sm *sm) 25051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 25061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return sm->tdls_external_setup; 25071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 2508