xref: /freebsd/contrib/wpa/src/eap_common/eap_sake_common.c (revision a90b9d0159070121c221b966469c3e36d912bf82)
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 
eap_sake_parse_add_attr(struct eap_sake_parse_attr * attr,u8 attr_id,u8 len,const u8 * data)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  */
eap_sake_parse_attributes(const u8 * buf,size_t len,struct eap_sake_parse_attr * attr)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  */
eap_sake_kdf(const u8 * key,size_t key_len,const char * label,const u8 * data,size_t data_len,const u8 * data2,size_t data2_len,u8 * buf,size_t buf_len)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  */
eap_sake_derive_keys(const u8 * root_secret_a,const u8 * root_secret_b,const u8 * rand_s,const u8 * rand_p,u8 * tek,u8 * msk,u8 * emsk)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  */
eap_sake_compute_mic(const u8 * tek_auth,const u8 * rand_s,const u8 * rand_p,const u8 * serverid,size_t serverid_len,const u8 * peerid,size_t peerid_len,int peer,const u8 * eap,size_t eap_len,const u8 * mic_pos,u8 * mic)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 
eap_sake_add_attr(struct wpabuf * buf,u8 type,const u8 * data,size_t len)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