139beb93cSSam Leffler /* 239beb93cSSam Leffler * EAP server/peer: EAP-SAKE shared routines 34bc52338SCy Schubert * Copyright (c) 2006-2019, Jouni Malinen <j@w1.fi> 439beb93cSSam Leffler * 5f05cddf9SRui Paulo * This software may be distributed under the terms of the BSD license. 6f05cddf9SRui Paulo * See README for more details. 739beb93cSSam Leffler */ 839beb93cSSam Leffler 939beb93cSSam Leffler #include "includes.h" 1039beb93cSSam Leffler 1139beb93cSSam Leffler #include "common.h" 1239beb93cSSam Leffler #include "wpabuf.h" 13e28a4053SRui Paulo #include "crypto/sha1.h" 1439beb93cSSam Leffler #include "eap_defs.h" 1539beb93cSSam Leffler #include "eap_sake_common.h" 1639beb93cSSam Leffler 1739beb93cSSam Leffler 1839beb93cSSam Leffler static int eap_sake_parse_add_attr(struct eap_sake_parse_attr *attr, 19325151a3SRui Paulo u8 attr_id, u8 len, const u8 *data) 2039beb93cSSam Leffler { 2139beb93cSSam Leffler size_t i; 2239beb93cSSam Leffler 23325151a3SRui Paulo switch (attr_id) { 2439beb93cSSam Leffler case EAP_SAKE_AT_RAND_S: 2539beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_RAND_S"); 26325151a3SRui Paulo if (len != EAP_SAKE_RAND_LEN) { 2739beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: AT_RAND_S with " 28325151a3SRui Paulo "invalid payload length %d", len); 2939beb93cSSam Leffler return -1; 3039beb93cSSam Leffler } 31325151a3SRui Paulo attr->rand_s = data; 3239beb93cSSam Leffler break; 3339beb93cSSam Leffler case EAP_SAKE_AT_RAND_P: 3439beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_RAND_P"); 35325151a3SRui Paulo if (len != EAP_SAKE_RAND_LEN) { 3639beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: AT_RAND_P with " 37325151a3SRui Paulo "invalid payload length %d", len); 3839beb93cSSam Leffler return -1; 3939beb93cSSam Leffler } 40325151a3SRui Paulo attr->rand_p = data; 4139beb93cSSam Leffler break; 4239beb93cSSam Leffler case EAP_SAKE_AT_MIC_S: 4339beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_MIC_S"); 44325151a3SRui Paulo if (len != EAP_SAKE_MIC_LEN) { 4539beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: AT_MIC_S with " 46325151a3SRui Paulo "invalid payload length %d", len); 4739beb93cSSam Leffler return -1; 4839beb93cSSam Leffler } 49325151a3SRui Paulo attr->mic_s = data; 5039beb93cSSam Leffler break; 5139beb93cSSam Leffler case EAP_SAKE_AT_MIC_P: 5239beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_MIC_P"); 53325151a3SRui Paulo if (len != EAP_SAKE_MIC_LEN) { 5439beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: AT_MIC_P with " 55325151a3SRui Paulo "invalid payload length %d", len); 5639beb93cSSam Leffler return -1; 5739beb93cSSam Leffler } 58325151a3SRui Paulo attr->mic_p = data; 5939beb93cSSam Leffler break; 6039beb93cSSam Leffler case EAP_SAKE_AT_SERVERID: 6139beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_SERVERID"); 62325151a3SRui Paulo attr->serverid = data; 63325151a3SRui Paulo attr->serverid_len = len; 6439beb93cSSam Leffler break; 6539beb93cSSam Leffler case EAP_SAKE_AT_PEERID: 6639beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_PEERID"); 67325151a3SRui Paulo attr->peerid = data; 68325151a3SRui Paulo attr->peerid_len = len; 6939beb93cSSam Leffler break; 7039beb93cSSam Leffler case EAP_SAKE_AT_SPI_S: 7139beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_SPI_S"); 72325151a3SRui Paulo attr->spi_s = data; 73325151a3SRui Paulo attr->spi_s_len = len; 7439beb93cSSam Leffler break; 7539beb93cSSam Leffler case EAP_SAKE_AT_SPI_P: 7639beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_SPI_P"); 77325151a3SRui Paulo attr->spi_p = data; 78325151a3SRui Paulo attr->spi_p_len = len; 7939beb93cSSam Leffler break; 8039beb93cSSam Leffler case EAP_SAKE_AT_ANY_ID_REQ: 8139beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_ANY_ID_REQ"); 82325151a3SRui Paulo if (len != 2) { 8339beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Invalid AT_ANY_ID_REQ" 84325151a3SRui Paulo " payload length %d", len); 8539beb93cSSam Leffler return -1; 8639beb93cSSam Leffler } 87325151a3SRui Paulo attr->any_id_req = data; 8839beb93cSSam Leffler break; 8939beb93cSSam Leffler case EAP_SAKE_AT_PERM_ID_REQ: 9039beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_PERM_ID_REQ"); 91325151a3SRui Paulo if (len != 2) { 9239beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Invalid " 93325151a3SRui Paulo "AT_PERM_ID_REQ payload length %d", len); 9439beb93cSSam Leffler return -1; 9539beb93cSSam Leffler } 96325151a3SRui Paulo attr->perm_id_req = data; 9739beb93cSSam Leffler break; 9839beb93cSSam Leffler case EAP_SAKE_AT_ENCR_DATA: 9939beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_ENCR_DATA"); 100325151a3SRui Paulo attr->encr_data = data; 101325151a3SRui Paulo attr->encr_data_len = len; 10239beb93cSSam Leffler break; 10339beb93cSSam Leffler case EAP_SAKE_AT_IV: 10439beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_IV"); 105325151a3SRui Paulo attr->iv = data; 106325151a3SRui Paulo attr->iv_len = len; 10739beb93cSSam Leffler break; 10839beb93cSSam Leffler case EAP_SAKE_AT_PADDING: 10939beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_PADDING"); 110325151a3SRui Paulo for (i = 0; i < len; i++) { 111325151a3SRui Paulo if (data[i]) { 11239beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: AT_PADDING " 11339beb93cSSam Leffler "with non-zero pad byte"); 11439beb93cSSam Leffler return -1; 11539beb93cSSam Leffler } 11639beb93cSSam Leffler } 11739beb93cSSam Leffler break; 11839beb93cSSam Leffler case EAP_SAKE_AT_NEXT_TMPID: 11939beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_NEXT_TMPID"); 120325151a3SRui Paulo attr->next_tmpid = data; 121325151a3SRui Paulo attr->next_tmpid_len = len; 12239beb93cSSam Leffler break; 12339beb93cSSam Leffler case EAP_SAKE_AT_MSK_LIFE: 124780fb4a2SCy Schubert wpa_printf(MSG_DEBUG, "EAP-SAKE: Parse: AT_MSK_LIFE"); 125325151a3SRui Paulo if (len != 4) { 12639beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Invalid " 127325151a3SRui Paulo "AT_MSK_LIFE payload length %d", len); 12839beb93cSSam Leffler return -1; 12939beb93cSSam Leffler } 130325151a3SRui Paulo attr->msk_life = data; 13139beb93cSSam Leffler break; 13239beb93cSSam Leffler default: 133325151a3SRui Paulo if (attr_id < 128) { 13439beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Unknown non-skippable" 135325151a3SRui Paulo " attribute %d", attr_id); 13639beb93cSSam Leffler return -1; 13739beb93cSSam Leffler } 13839beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Ignoring unknown skippable " 139325151a3SRui Paulo "attribute %d", attr_id); 14039beb93cSSam Leffler break; 14139beb93cSSam Leffler } 14239beb93cSSam Leffler 14339beb93cSSam Leffler if (attr->iv && !attr->encr_data) { 14439beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: AT_IV included without " 14539beb93cSSam Leffler "AT_ENCR_DATA"); 14639beb93cSSam Leffler return -1; 14739beb93cSSam Leffler } 14839beb93cSSam Leffler 14939beb93cSSam Leffler return 0; 15039beb93cSSam Leffler } 15139beb93cSSam Leffler 15239beb93cSSam Leffler 15339beb93cSSam Leffler /** 15439beb93cSSam Leffler * eap_sake_parse_attributes - Parse EAP-SAKE attributes 15539beb93cSSam Leffler * @buf: Packet payload (starting with the first attribute) 15639beb93cSSam Leffler * @len: Payload length 15739beb93cSSam Leffler * @attr: Structure to be filled with found attributes 15839beb93cSSam Leffler * Returns: 0 on success or -1 on failure 15939beb93cSSam Leffler */ 16039beb93cSSam Leffler int eap_sake_parse_attributes(const u8 *buf, size_t len, 16139beb93cSSam Leffler struct eap_sake_parse_attr *attr) 16239beb93cSSam Leffler { 16339beb93cSSam Leffler const u8 *pos = buf, *end = buf + len; 16439beb93cSSam Leffler 16539beb93cSSam Leffler os_memset(attr, 0, sizeof(*attr)); 16639beb93cSSam Leffler while (pos < end) { 167*a90b9d01SCy Schubert u8 attr_id, attr_len; 168*a90b9d01SCy Schubert 16939beb93cSSam Leffler if (end - pos < 2) { 17039beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Too short attribute"); 17139beb93cSSam Leffler return -1; 17239beb93cSSam Leffler } 17339beb93cSSam Leffler 174*a90b9d01SCy Schubert attr_id = *pos++; 175*a90b9d01SCy Schubert attr_len = *pos++; 176*a90b9d01SCy Schubert /* Attribute length value includes the Type and Length fields */ 177*a90b9d01SCy Schubert if (attr_len < 2) { 178*a90b9d01SCy Schubert wpa_printf(MSG_DEBUG, 179*a90b9d01SCy Schubert "EAP-SAKE: Invalid attribute length (%d)", 180*a90b9d01SCy Schubert attr_len); 18139beb93cSSam Leffler return -1; 18239beb93cSSam Leffler } 183*a90b9d01SCy Schubert attr_len -= 2; 18439beb93cSSam Leffler 185*a90b9d01SCy Schubert if (attr_len > end - pos) { 18639beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Attribute underflow"); 18739beb93cSSam Leffler return -1; 18839beb93cSSam Leffler } 18939beb93cSSam Leffler 190*a90b9d01SCy Schubert if (eap_sake_parse_add_attr(attr, attr_id, attr_len, pos)) 19139beb93cSSam Leffler return -1; 19239beb93cSSam Leffler 193*a90b9d01SCy Schubert pos += attr_len; 19439beb93cSSam Leffler } 19539beb93cSSam Leffler 19639beb93cSSam Leffler return 0; 19739beb93cSSam Leffler } 19839beb93cSSam Leffler 19939beb93cSSam Leffler 20039beb93cSSam Leffler /** 20139beb93cSSam Leffler * eap_sake_kdf - EAP-SAKE Key Derivation Function (KDF) 20239beb93cSSam Leffler * @key: Key for KDF 20339beb93cSSam Leffler * @key_len: Length of the key in bytes 20439beb93cSSam Leffler * @label: A unique label for each purpose of the KDF 20539beb93cSSam Leffler * @data: Extra data (start) to bind into the key 20639beb93cSSam Leffler * @data_len: Length of the data 20739beb93cSSam Leffler * @data2: Extra data (end) to bind into the key 20839beb93cSSam Leffler * @data2_len: Length of the data2 20939beb93cSSam Leffler * @buf: Buffer for the generated pseudo-random key 21039beb93cSSam Leffler * @buf_len: Number of bytes of key to generate 2114bc52338SCy Schubert * Returns: 0 on success or -1 on failure 21239beb93cSSam Leffler * 21339beb93cSSam Leffler * This function is used to derive new, cryptographically separate keys from a 21439beb93cSSam Leffler * given key (e.g., SMS). This is identical to the PRF used in IEEE 802.11i. 21539beb93cSSam Leffler */ 2164bc52338SCy Schubert static int eap_sake_kdf(const u8 *key, size_t key_len, const char *label, 21739beb93cSSam Leffler const u8 *data, size_t data_len, 21839beb93cSSam Leffler const u8 *data2, size_t data2_len, 21939beb93cSSam Leffler u8 *buf, size_t buf_len) 22039beb93cSSam Leffler { 22139beb93cSSam Leffler u8 counter = 0; 22239beb93cSSam Leffler size_t pos, plen; 22339beb93cSSam Leffler u8 hash[SHA1_MAC_LEN]; 22439beb93cSSam Leffler size_t label_len = os_strlen(label) + 1; 22539beb93cSSam Leffler const unsigned char *addr[4]; 22639beb93cSSam Leffler size_t len[4]; 22739beb93cSSam Leffler 22839beb93cSSam Leffler addr[0] = (u8 *) label; /* Label | Y */ 22939beb93cSSam Leffler len[0] = label_len; 23039beb93cSSam Leffler addr[1] = data; /* Msg[start] */ 23139beb93cSSam Leffler len[1] = data_len; 23239beb93cSSam Leffler addr[2] = data2; /* Msg[end] */ 23339beb93cSSam Leffler len[2] = data2_len; 23439beb93cSSam Leffler addr[3] = &counter; /* Length */ 23539beb93cSSam Leffler len[3] = 1; 23639beb93cSSam Leffler 23739beb93cSSam Leffler pos = 0; 23839beb93cSSam Leffler while (pos < buf_len) { 23939beb93cSSam Leffler plen = buf_len - pos; 24039beb93cSSam Leffler if (plen >= SHA1_MAC_LEN) { 2414bc52338SCy Schubert if (hmac_sha1_vector(key, key_len, 4, addr, len, 2424bc52338SCy Schubert &buf[pos]) < 0) 2434bc52338SCy Schubert return -1; 24439beb93cSSam Leffler pos += SHA1_MAC_LEN; 24539beb93cSSam Leffler } else { 2464bc52338SCy Schubert if (hmac_sha1_vector(key, key_len, 4, addr, len, 2474bc52338SCy Schubert hash) < 0) 2484bc52338SCy Schubert return -1; 24939beb93cSSam Leffler os_memcpy(&buf[pos], hash, plen); 25039beb93cSSam Leffler break; 25139beb93cSSam Leffler } 25239beb93cSSam Leffler counter++; 25339beb93cSSam Leffler } 2544bc52338SCy Schubert 2554bc52338SCy Schubert return 0; 25639beb93cSSam Leffler } 25739beb93cSSam Leffler 25839beb93cSSam Leffler 25939beb93cSSam Leffler /** 26039beb93cSSam Leffler * eap_sake_derive_keys - Derive EAP-SAKE keys 26139beb93cSSam Leffler * @root_secret_a: 16-byte Root-Secret-A 26239beb93cSSam Leffler * @root_secret_b: 16-byte Root-Secret-B 26339beb93cSSam Leffler * @rand_s: 16-byte RAND_S 26439beb93cSSam Leffler * @rand_p: 16-byte RAND_P 26539beb93cSSam Leffler * @tek: Buffer for Temporary EAK Keys (TEK-Auth[16] | TEK-Cipher[16]) 26639beb93cSSam Leffler * @msk: Buffer for 64-byte MSK 26739beb93cSSam Leffler * @emsk: Buffer for 64-byte EMSK 2684bc52338SCy Schubert * Returns: 0 on success or -1 on failure 26939beb93cSSam Leffler * 27039beb93cSSam Leffler * This function derives EAP-SAKE keys as defined in RFC 4763, section 3.2.6. 27139beb93cSSam Leffler */ 2724bc52338SCy Schubert int eap_sake_derive_keys(const u8 *root_secret_a, const u8 *root_secret_b, 27339beb93cSSam Leffler const u8 *rand_s, const u8 *rand_p, u8 *tek, u8 *msk, 27439beb93cSSam Leffler u8 *emsk) 27539beb93cSSam Leffler { 27639beb93cSSam Leffler u8 sms_a[EAP_SAKE_SMS_LEN]; 27739beb93cSSam Leffler u8 sms_b[EAP_SAKE_SMS_LEN]; 27839beb93cSSam Leffler u8 key_buf[EAP_MSK_LEN + EAP_EMSK_LEN]; 27939beb93cSSam Leffler 28039beb93cSSam Leffler wpa_printf(MSG_DEBUG, "EAP-SAKE: Deriving keys"); 28139beb93cSSam Leffler 28239beb93cSSam Leffler wpa_hexdump_key(MSG_DEBUG, "EAP-SAKE: Root-Secret-A", 28339beb93cSSam Leffler root_secret_a, EAP_SAKE_ROOT_SECRET_LEN); 2844bc52338SCy Schubert if (eap_sake_kdf(root_secret_a, EAP_SAKE_ROOT_SECRET_LEN, 28539beb93cSSam Leffler "SAKE Master Secret A", 28639beb93cSSam Leffler rand_p, EAP_SAKE_RAND_LEN, rand_s, EAP_SAKE_RAND_LEN, 2874bc52338SCy Schubert sms_a, EAP_SAKE_SMS_LEN) < 0) 2884bc52338SCy Schubert return -1; 28939beb93cSSam Leffler wpa_hexdump_key(MSG_DEBUG, "EAP-SAKE: SMS-A", sms_a, EAP_SAKE_SMS_LEN); 2904bc52338SCy Schubert if (eap_sake_kdf(sms_a, EAP_SAKE_SMS_LEN, "Transient EAP Key", 29139beb93cSSam Leffler rand_s, EAP_SAKE_RAND_LEN, rand_p, EAP_SAKE_RAND_LEN, 2924bc52338SCy Schubert tek, EAP_SAKE_TEK_LEN) < 0) 2934bc52338SCy Schubert return -1; 29439beb93cSSam Leffler wpa_hexdump_key(MSG_DEBUG, "EAP-SAKE: TEK-Auth", 29539beb93cSSam Leffler tek, EAP_SAKE_TEK_AUTH_LEN); 29639beb93cSSam Leffler wpa_hexdump_key(MSG_DEBUG, "EAP-SAKE: TEK-Cipher", 29739beb93cSSam Leffler tek + EAP_SAKE_TEK_AUTH_LEN, EAP_SAKE_TEK_CIPHER_LEN); 29839beb93cSSam Leffler 29939beb93cSSam Leffler wpa_hexdump_key(MSG_DEBUG, "EAP-SAKE: Root-Secret-B", 30039beb93cSSam Leffler root_secret_b, EAP_SAKE_ROOT_SECRET_LEN); 3014bc52338SCy Schubert if (eap_sake_kdf(root_secret_b, EAP_SAKE_ROOT_SECRET_LEN, 30239beb93cSSam Leffler "SAKE Master Secret B", 30339beb93cSSam Leffler rand_p, EAP_SAKE_RAND_LEN, rand_s, EAP_SAKE_RAND_LEN, 3044bc52338SCy Schubert sms_b, EAP_SAKE_SMS_LEN) < 0) 3054bc52338SCy Schubert return -1; 30639beb93cSSam Leffler wpa_hexdump_key(MSG_DEBUG, "EAP-SAKE: SMS-B", sms_b, EAP_SAKE_SMS_LEN); 3074bc52338SCy Schubert if (eap_sake_kdf(sms_b, EAP_SAKE_SMS_LEN, "Master Session Key", 30839beb93cSSam Leffler rand_s, EAP_SAKE_RAND_LEN, rand_p, EAP_SAKE_RAND_LEN, 3094bc52338SCy Schubert key_buf, sizeof(key_buf)) < 0) 3104bc52338SCy Schubert return -1; 31139beb93cSSam Leffler os_memcpy(msk, key_buf, EAP_MSK_LEN); 31239beb93cSSam Leffler os_memcpy(emsk, key_buf + EAP_MSK_LEN, EAP_EMSK_LEN); 31339beb93cSSam Leffler wpa_hexdump_key(MSG_DEBUG, "EAP-SAKE: MSK", msk, EAP_MSK_LEN); 31439beb93cSSam Leffler wpa_hexdump_key(MSG_DEBUG, "EAP-SAKE: EMSK", emsk, EAP_EMSK_LEN); 3154bc52338SCy Schubert return 0; 31639beb93cSSam Leffler } 31739beb93cSSam Leffler 31839beb93cSSam Leffler 31939beb93cSSam Leffler /** 32039beb93cSSam Leffler * eap_sake_compute_mic - Compute EAP-SAKE MIC for an EAP packet 32139beb93cSSam Leffler * @tek_auth: 16-byte TEK-Auth 32239beb93cSSam Leffler * @rand_s: 16-byte RAND_S 32339beb93cSSam Leffler * @rand_p: 16-byte RAND_P 32439beb93cSSam Leffler * @serverid: SERVERID 32539beb93cSSam Leffler * @serverid_len: SERVERID length 32639beb93cSSam Leffler * @peerid: PEERID 32739beb93cSSam Leffler * @peerid_len: PEERID length 32839beb93cSSam Leffler * @peer: MIC calculation for 0 = Server, 1 = Peer message 32939beb93cSSam Leffler * @eap: EAP packet 33039beb93cSSam Leffler * @eap_len: EAP packet length 33139beb93cSSam Leffler * @mic_pos: MIC position in the EAP packet (must be [eap .. eap + eap_len]) 33239beb93cSSam Leffler * @mic: Buffer for the computed 16-byte MIC 3334bc52338SCy Schubert * Returns: 0 on success or -1 on failure 33439beb93cSSam Leffler */ 33539beb93cSSam Leffler int eap_sake_compute_mic(const u8 *tek_auth, 33639beb93cSSam Leffler const u8 *rand_s, const u8 *rand_p, 33739beb93cSSam Leffler const u8 *serverid, size_t serverid_len, 33839beb93cSSam Leffler const u8 *peerid, size_t peerid_len, 33939beb93cSSam Leffler int peer, const u8 *eap, size_t eap_len, 34039beb93cSSam Leffler const u8 *mic_pos, u8 *mic) 34139beb93cSSam Leffler { 34239beb93cSSam Leffler u8 _rand[2 * EAP_SAKE_RAND_LEN]; 34339beb93cSSam Leffler u8 *tmp, *pos; 34439beb93cSSam Leffler size_t tmplen; 3454bc52338SCy Schubert int ret; 34639beb93cSSam Leffler 34739beb93cSSam Leffler tmplen = serverid_len + 1 + peerid_len + 1 + eap_len; 34839beb93cSSam Leffler tmp = os_malloc(tmplen); 34939beb93cSSam Leffler if (tmp == NULL) 35039beb93cSSam Leffler return -1; 35139beb93cSSam Leffler pos = tmp; 35239beb93cSSam Leffler if (peer) { 35339beb93cSSam Leffler if (peerid) { 35439beb93cSSam Leffler os_memcpy(pos, peerid, peerid_len); 35539beb93cSSam Leffler pos += peerid_len; 35639beb93cSSam Leffler } 35739beb93cSSam Leffler *pos++ = 0x00; 35839beb93cSSam Leffler if (serverid) { 35939beb93cSSam Leffler os_memcpy(pos, serverid, serverid_len); 36039beb93cSSam Leffler pos += serverid_len; 36139beb93cSSam Leffler } 36239beb93cSSam Leffler *pos++ = 0x00; 36339beb93cSSam Leffler 36439beb93cSSam Leffler os_memcpy(_rand, rand_s, EAP_SAKE_RAND_LEN); 36539beb93cSSam Leffler os_memcpy(_rand + EAP_SAKE_RAND_LEN, rand_p, 36639beb93cSSam Leffler EAP_SAKE_RAND_LEN); 36739beb93cSSam Leffler } else { 36839beb93cSSam Leffler if (serverid) { 36939beb93cSSam Leffler os_memcpy(pos, serverid, serverid_len); 37039beb93cSSam Leffler pos += serverid_len; 37139beb93cSSam Leffler } 37239beb93cSSam Leffler *pos++ = 0x00; 37339beb93cSSam Leffler if (peerid) { 37439beb93cSSam Leffler os_memcpy(pos, peerid, peerid_len); 37539beb93cSSam Leffler pos += peerid_len; 37639beb93cSSam Leffler } 37739beb93cSSam Leffler *pos++ = 0x00; 37839beb93cSSam Leffler 37939beb93cSSam Leffler os_memcpy(_rand, rand_p, EAP_SAKE_RAND_LEN); 38039beb93cSSam Leffler os_memcpy(_rand + EAP_SAKE_RAND_LEN, rand_s, 38139beb93cSSam Leffler EAP_SAKE_RAND_LEN); 38239beb93cSSam Leffler } 38339beb93cSSam Leffler 38439beb93cSSam Leffler os_memcpy(pos, eap, eap_len); 38539beb93cSSam Leffler os_memset(pos + (mic_pos - eap), 0, EAP_SAKE_MIC_LEN); 38639beb93cSSam Leffler 3874bc52338SCy Schubert ret = eap_sake_kdf(tek_auth, EAP_SAKE_TEK_AUTH_LEN, 38839beb93cSSam Leffler peer ? "Peer MIC" : "Server MIC", 38939beb93cSSam Leffler _rand, 2 * EAP_SAKE_RAND_LEN, tmp, tmplen, 39039beb93cSSam Leffler mic, EAP_SAKE_MIC_LEN); 39139beb93cSSam Leffler 39239beb93cSSam Leffler os_free(tmp); 39339beb93cSSam Leffler 3944bc52338SCy Schubert return ret; 39539beb93cSSam Leffler } 39639beb93cSSam Leffler 39739beb93cSSam Leffler 39839beb93cSSam Leffler void eap_sake_add_attr(struct wpabuf *buf, u8 type, const u8 *data, 39939beb93cSSam Leffler size_t len) 40039beb93cSSam Leffler { 40139beb93cSSam Leffler wpabuf_put_u8(buf, type); 40239beb93cSSam Leffler wpabuf_put_u8(buf, 2 + len); /* Length; including attr header */ 40339beb93cSSam Leffler if (data) 40439beb93cSSam Leffler wpabuf_put_data(buf, data, len); 40539beb93cSSam Leffler else 40639beb93cSSam Leffler os_memset(wpabuf_put(buf, len), 0, len); 40739beb93cSSam Leffler } 408