16d49e1aeSJan Lentfer /*
26d49e1aeSJan Lentfer  * EAP peer/server: EAP-SIM/AKA/AKA' shared routines
36d49e1aeSJan Lentfer  * Copyright (c) 2004-2008, Jouni Malinen <j@w1.fi>
46d49e1aeSJan Lentfer  *
53ff40c12SJohn Marino  * This software may be distributed under the terms of the BSD license.
63ff40c12SJohn Marino  * See README for more details.
76d49e1aeSJan Lentfer  */
86d49e1aeSJan Lentfer 
96d49e1aeSJan Lentfer #include "includes.h"
106d49e1aeSJan Lentfer 
116d49e1aeSJan Lentfer #include "common.h"
126d49e1aeSJan Lentfer #include "wpabuf.h"
133ff40c12SJohn Marino #include "crypto/aes_wrap.h"
143ff40c12SJohn Marino #include "crypto/crypto.h"
153ff40c12SJohn Marino #include "crypto/sha1.h"
163ff40c12SJohn Marino #include "crypto/sha256.h"
173ff40c12SJohn Marino #include "crypto/random.h"
183ff40c12SJohn Marino #include "eap_common/eap_defs.h"
196d49e1aeSJan Lentfer #include "eap_common/eap_sim_common.h"
206d49e1aeSJan Lentfer 
216d49e1aeSJan Lentfer 
eap_sim_prf(const u8 * key,u8 * x,size_t xlen)226d49e1aeSJan Lentfer static int eap_sim_prf(const u8 *key, u8 *x, size_t xlen)
236d49e1aeSJan Lentfer {
246d49e1aeSJan Lentfer 	return fips186_2_prf(key, EAP_SIM_MK_LEN, x, xlen);
256d49e1aeSJan Lentfer }
266d49e1aeSJan Lentfer 
276d49e1aeSJan Lentfer 
eap_sim_derive_mk(const u8 * identity,size_t identity_len,const u8 * nonce_mt,u16 selected_version,const u8 * ver_list,size_t ver_list_len,int num_chal,const u8 * kc,u8 * mk)286d49e1aeSJan Lentfer void eap_sim_derive_mk(const u8 *identity, size_t identity_len,
296d49e1aeSJan Lentfer 		       const u8 *nonce_mt, u16 selected_version,
306d49e1aeSJan Lentfer 		       const u8 *ver_list, size_t ver_list_len,
316d49e1aeSJan Lentfer 		       int num_chal, const u8 *kc, u8 *mk)
326d49e1aeSJan Lentfer {
336d49e1aeSJan Lentfer 	u8 sel_ver[2];
346d49e1aeSJan Lentfer 	const unsigned char *addr[5];
356d49e1aeSJan Lentfer 	size_t len[5];
366d49e1aeSJan Lentfer 
376d49e1aeSJan Lentfer 	addr[0] = identity;
386d49e1aeSJan Lentfer 	len[0] = identity_len;
396d49e1aeSJan Lentfer 	addr[1] = kc;
406d49e1aeSJan Lentfer 	len[1] = num_chal * EAP_SIM_KC_LEN;
416d49e1aeSJan Lentfer 	addr[2] = nonce_mt;
426d49e1aeSJan Lentfer 	len[2] = EAP_SIM_NONCE_MT_LEN;
436d49e1aeSJan Lentfer 	addr[3] = ver_list;
446d49e1aeSJan Lentfer 	len[3] = ver_list_len;
456d49e1aeSJan Lentfer 	addr[4] = sel_ver;
466d49e1aeSJan Lentfer 	len[4] = 2;
476d49e1aeSJan Lentfer 
486d49e1aeSJan Lentfer 	WPA_PUT_BE16(sel_ver, selected_version);
496d49e1aeSJan Lentfer 
506d49e1aeSJan Lentfer 	/* MK = SHA1(Identity|n*Kc|NONCE_MT|Version List|Selected Version) */
516d49e1aeSJan Lentfer 	sha1_vector(5, addr, len, mk);
526d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-SIM: MK", mk, EAP_SIM_MK_LEN);
536d49e1aeSJan Lentfer }
546d49e1aeSJan Lentfer 
556d49e1aeSJan Lentfer 
eap_aka_derive_mk(const u8 * identity,size_t identity_len,const u8 * ik,const u8 * ck,u8 * mk)566d49e1aeSJan Lentfer void eap_aka_derive_mk(const u8 *identity, size_t identity_len,
576d49e1aeSJan Lentfer 		       const u8 *ik, const u8 *ck, u8 *mk)
586d49e1aeSJan Lentfer {
596d49e1aeSJan Lentfer 	const u8 *addr[3];
606d49e1aeSJan Lentfer 	size_t len[3];
616d49e1aeSJan Lentfer 
626d49e1aeSJan Lentfer 	addr[0] = identity;
636d49e1aeSJan Lentfer 	len[0] = identity_len;
646d49e1aeSJan Lentfer 	addr[1] = ik;
656d49e1aeSJan Lentfer 	len[1] = EAP_AKA_IK_LEN;
666d49e1aeSJan Lentfer 	addr[2] = ck;
676d49e1aeSJan Lentfer 	len[2] = EAP_AKA_CK_LEN;
686d49e1aeSJan Lentfer 
696d49e1aeSJan Lentfer 	/* MK = SHA1(Identity|IK|CK) */
706d49e1aeSJan Lentfer 	sha1_vector(3, addr, len, mk);
716d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA: IK", ik, EAP_AKA_IK_LEN);
726d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA: CK", ck, EAP_AKA_CK_LEN);
736d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA: MK", mk, EAP_SIM_MK_LEN);
746d49e1aeSJan Lentfer }
756d49e1aeSJan Lentfer 
766d49e1aeSJan Lentfer 
eap_sim_derive_keys(const u8 * mk,u8 * k_encr,u8 * k_aut,u8 * msk,u8 * emsk)776d49e1aeSJan Lentfer int eap_sim_derive_keys(const u8 *mk, u8 *k_encr, u8 *k_aut, u8 *msk, u8 *emsk)
786d49e1aeSJan Lentfer {
796d49e1aeSJan Lentfer 	u8 buf[EAP_SIM_K_ENCR_LEN + EAP_SIM_K_AUT_LEN +
806d49e1aeSJan Lentfer 	       EAP_SIM_KEYING_DATA_LEN + EAP_EMSK_LEN], *pos;
816d49e1aeSJan Lentfer 	if (eap_sim_prf(mk, buf, sizeof(buf)) < 0) {
826d49e1aeSJan Lentfer 		wpa_printf(MSG_ERROR, "EAP-SIM: Failed to derive keys");
836d49e1aeSJan Lentfer 		return -1;
846d49e1aeSJan Lentfer 	}
856d49e1aeSJan Lentfer 	pos = buf;
866d49e1aeSJan Lentfer 	os_memcpy(k_encr, pos, EAP_SIM_K_ENCR_LEN);
876d49e1aeSJan Lentfer 	pos += EAP_SIM_K_ENCR_LEN;
886d49e1aeSJan Lentfer 	os_memcpy(k_aut, pos, EAP_SIM_K_AUT_LEN);
896d49e1aeSJan Lentfer 	pos += EAP_SIM_K_AUT_LEN;
906d49e1aeSJan Lentfer 	os_memcpy(msk, pos, EAP_SIM_KEYING_DATA_LEN);
916d49e1aeSJan Lentfer 	pos += EAP_SIM_KEYING_DATA_LEN;
926d49e1aeSJan Lentfer 	os_memcpy(emsk, pos, EAP_EMSK_LEN);
936d49e1aeSJan Lentfer 
946d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-SIM: K_encr",
956d49e1aeSJan Lentfer 			k_encr, EAP_SIM_K_ENCR_LEN);
966d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-SIM: K_aut",
976d49e1aeSJan Lentfer 			k_aut, EAP_SIM_K_AUT_LEN);
986d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-SIM: keying material (MSK)",
996d49e1aeSJan Lentfer 			msk, EAP_SIM_KEYING_DATA_LEN);
1006d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-SIM: EMSK", emsk, EAP_EMSK_LEN);
1016d49e1aeSJan Lentfer 	os_memset(buf, 0, sizeof(buf));
1026d49e1aeSJan Lentfer 
1036d49e1aeSJan Lentfer 	return 0;
1046d49e1aeSJan Lentfer }
1056d49e1aeSJan Lentfer 
1066d49e1aeSJan Lentfer 
eap_sim_derive_keys_reauth(u16 _counter,const u8 * identity,size_t identity_len,const u8 * nonce_s,const u8 * mk,u8 * msk,u8 * emsk)1076d49e1aeSJan Lentfer int eap_sim_derive_keys_reauth(u16 _counter,
1086d49e1aeSJan Lentfer 			       const u8 *identity, size_t identity_len,
1096d49e1aeSJan Lentfer 			       const u8 *nonce_s, const u8 *mk, u8 *msk,
1106d49e1aeSJan Lentfer 			       u8 *emsk)
1116d49e1aeSJan Lentfer {
1126d49e1aeSJan Lentfer 	u8 xkey[SHA1_MAC_LEN];
1136d49e1aeSJan Lentfer 	u8 buf[EAP_SIM_KEYING_DATA_LEN + EAP_EMSK_LEN + 32];
1146d49e1aeSJan Lentfer 	u8 counter[2];
1156d49e1aeSJan Lentfer 	const u8 *addr[4];
1166d49e1aeSJan Lentfer 	size_t len[4];
1176d49e1aeSJan Lentfer 
1186d49e1aeSJan Lentfer 	while (identity_len > 0 && identity[identity_len - 1] == 0) {
1196d49e1aeSJan Lentfer 		wpa_printf(MSG_DEBUG, "EAP-SIM: Workaround - drop null "
1206d49e1aeSJan Lentfer 			   "character from the end of identity");
1216d49e1aeSJan Lentfer 		identity_len--;
1226d49e1aeSJan Lentfer 	}
1236d49e1aeSJan Lentfer 	addr[0] = identity;
1246d49e1aeSJan Lentfer 	len[0] = identity_len;
1256d49e1aeSJan Lentfer 	addr[1] = counter;
1266d49e1aeSJan Lentfer 	len[1] = 2;
1276d49e1aeSJan Lentfer 	addr[2] = nonce_s;
1286d49e1aeSJan Lentfer 	len[2] = EAP_SIM_NONCE_S_LEN;
1296d49e1aeSJan Lentfer 	addr[3] = mk;
1306d49e1aeSJan Lentfer 	len[3] = EAP_SIM_MK_LEN;
1316d49e1aeSJan Lentfer 
1326d49e1aeSJan Lentfer 	WPA_PUT_BE16(counter, _counter);
1336d49e1aeSJan Lentfer 
1346d49e1aeSJan Lentfer 	wpa_printf(MSG_DEBUG, "EAP-SIM: Deriving keying data from reauth");
1356d49e1aeSJan Lentfer 	wpa_hexdump_ascii(MSG_DEBUG, "EAP-SIM: Identity",
1366d49e1aeSJan Lentfer 			  identity, identity_len);
1376d49e1aeSJan Lentfer 	wpa_hexdump(MSG_DEBUG, "EAP-SIM: counter", counter, 2);
1386d49e1aeSJan Lentfer 	wpa_hexdump(MSG_DEBUG, "EAP-SIM: NONCE_S", nonce_s,
1396d49e1aeSJan Lentfer 		    EAP_SIM_NONCE_S_LEN);
1406d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-SIM: MK", mk, EAP_SIM_MK_LEN);
1416d49e1aeSJan Lentfer 
1426d49e1aeSJan Lentfer 	/* XKEY' = SHA1(Identity|counter|NONCE_S|MK) */
1436d49e1aeSJan Lentfer 	sha1_vector(4, addr, len, xkey);
1446d49e1aeSJan Lentfer 	wpa_hexdump(MSG_DEBUG, "EAP-SIM: XKEY'", xkey, SHA1_MAC_LEN);
1456d49e1aeSJan Lentfer 
1466d49e1aeSJan Lentfer 	if (eap_sim_prf(xkey, buf, sizeof(buf)) < 0) {
1476d49e1aeSJan Lentfer 		wpa_printf(MSG_ERROR, "EAP-SIM: Failed to derive keys");
1486d49e1aeSJan Lentfer 		return -1;
1496d49e1aeSJan Lentfer 	}
1506d49e1aeSJan Lentfer 	if (msk) {
1516d49e1aeSJan Lentfer 		os_memcpy(msk, buf, EAP_SIM_KEYING_DATA_LEN);
1526d49e1aeSJan Lentfer 		wpa_hexdump(MSG_DEBUG, "EAP-SIM: keying material (MSK)",
1536d49e1aeSJan Lentfer 			    msk, EAP_SIM_KEYING_DATA_LEN);
1546d49e1aeSJan Lentfer 	}
1556d49e1aeSJan Lentfer 	if (emsk) {
1566d49e1aeSJan Lentfer 		os_memcpy(emsk, buf + EAP_SIM_KEYING_DATA_LEN, EAP_EMSK_LEN);
1576d49e1aeSJan Lentfer 		wpa_hexdump(MSG_DEBUG, "EAP-SIM: EMSK", emsk, EAP_EMSK_LEN);
1586d49e1aeSJan Lentfer 	}
1596d49e1aeSJan Lentfer 	os_memset(buf, 0, sizeof(buf));
1606d49e1aeSJan Lentfer 
1616d49e1aeSJan Lentfer 	return 0;
1626d49e1aeSJan Lentfer }
1636d49e1aeSJan Lentfer 
1646d49e1aeSJan Lentfer 
eap_sim_verify_mac(const u8 * k_aut,const struct wpabuf * req,const u8 * mac,const u8 * extra,size_t extra_len)1656d49e1aeSJan Lentfer int eap_sim_verify_mac(const u8 *k_aut, const struct wpabuf *req,
1666d49e1aeSJan Lentfer 		       const u8 *mac, const u8 *extra, size_t extra_len)
1676d49e1aeSJan Lentfer {
1686d49e1aeSJan Lentfer 	unsigned char hmac[SHA1_MAC_LEN];
1696d49e1aeSJan Lentfer 	const u8 *addr[2];
1706d49e1aeSJan Lentfer 	size_t len[2];
1716d49e1aeSJan Lentfer 	u8 *tmp;
1726d49e1aeSJan Lentfer 
1736d49e1aeSJan Lentfer 	if (mac == NULL || wpabuf_len(req) < EAP_SIM_MAC_LEN ||
1746d49e1aeSJan Lentfer 	    mac < wpabuf_head_u8(req) ||
1756d49e1aeSJan Lentfer 	    mac > wpabuf_head_u8(req) + wpabuf_len(req) - EAP_SIM_MAC_LEN)
1766d49e1aeSJan Lentfer 		return -1;
1776d49e1aeSJan Lentfer 
178*a1157835SDaniel Fojt 	tmp = os_memdup(wpabuf_head(req), wpabuf_len(req));
1796d49e1aeSJan Lentfer 	if (tmp == NULL)
1806d49e1aeSJan Lentfer 		return -1;
1816d49e1aeSJan Lentfer 
1826d49e1aeSJan Lentfer 	addr[0] = tmp;
1836d49e1aeSJan Lentfer 	len[0] = wpabuf_len(req);
1846d49e1aeSJan Lentfer 	addr[1] = extra;
1856d49e1aeSJan Lentfer 	len[1] = extra_len;
1866d49e1aeSJan Lentfer 
1876d49e1aeSJan Lentfer 	/* HMAC-SHA1-128 */
1886d49e1aeSJan Lentfer 	os_memset(tmp + (mac - wpabuf_head_u8(req)), 0, EAP_SIM_MAC_LEN);
1896d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-SIM: Verify MAC - msg",
1906d49e1aeSJan Lentfer 		    tmp, wpabuf_len(req));
1916d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-SIM: Verify MAC - extra data",
1926d49e1aeSJan Lentfer 		    extra, extra_len);
1936d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_MSGDUMP, "EAP-SIM: Verify MAC - K_aut",
1946d49e1aeSJan Lentfer 			k_aut, EAP_SIM_K_AUT_LEN);
1956d49e1aeSJan Lentfer 	hmac_sha1_vector(k_aut, EAP_SIM_K_AUT_LEN, 2, addr, len, hmac);
1966d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-SIM: Verify MAC: MAC",
1976d49e1aeSJan Lentfer 		    hmac, EAP_SIM_MAC_LEN);
1986d49e1aeSJan Lentfer 	os_free(tmp);
1996d49e1aeSJan Lentfer 
200*a1157835SDaniel Fojt 	return (os_memcmp_const(hmac, mac, EAP_SIM_MAC_LEN) == 0) ? 0 : 1;
2016d49e1aeSJan Lentfer }
2026d49e1aeSJan Lentfer 
2036d49e1aeSJan Lentfer 
eap_sim_add_mac(const u8 * k_aut,const u8 * msg,size_t msg_len,u8 * mac,const u8 * extra,size_t extra_len)2046d49e1aeSJan Lentfer void eap_sim_add_mac(const u8 *k_aut, const u8 *msg, size_t msg_len, u8 *mac,
2056d49e1aeSJan Lentfer 		     const u8 *extra, size_t extra_len)
2066d49e1aeSJan Lentfer {
2076d49e1aeSJan Lentfer 	unsigned char hmac[SHA1_MAC_LEN];
2086d49e1aeSJan Lentfer 	const u8 *addr[2];
2096d49e1aeSJan Lentfer 	size_t len[2];
2106d49e1aeSJan Lentfer 
2116d49e1aeSJan Lentfer 	addr[0] = msg;
2126d49e1aeSJan Lentfer 	len[0] = msg_len;
2136d49e1aeSJan Lentfer 	addr[1] = extra;
2146d49e1aeSJan Lentfer 	len[1] = extra_len;
2156d49e1aeSJan Lentfer 
2166d49e1aeSJan Lentfer 	/* HMAC-SHA1-128 */
2176d49e1aeSJan Lentfer 	os_memset(mac, 0, EAP_SIM_MAC_LEN);
2186d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-SIM: Add MAC - msg", msg, msg_len);
2196d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-SIM: Add MAC - extra data",
2206d49e1aeSJan Lentfer 		    extra, extra_len);
2216d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_MSGDUMP, "EAP-SIM: Add MAC - K_aut",
2226d49e1aeSJan Lentfer 			k_aut, EAP_SIM_K_AUT_LEN);
2236d49e1aeSJan Lentfer 	hmac_sha1_vector(k_aut, EAP_SIM_K_AUT_LEN, 2, addr, len, hmac);
2246d49e1aeSJan Lentfer 	os_memcpy(mac, hmac, EAP_SIM_MAC_LEN);
2256d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-SIM: Add MAC: MAC",
2266d49e1aeSJan Lentfer 		    mac, EAP_SIM_MAC_LEN);
2276d49e1aeSJan Lentfer }
2286d49e1aeSJan Lentfer 
2296d49e1aeSJan Lentfer 
2303ff40c12SJohn Marino #if defined(EAP_AKA_PRIME) || defined(EAP_SERVER_AKA_PRIME)
prf_prime(const u8 * k,const char * seed1,const u8 * seed2,size_t seed2_len,const u8 * seed3,size_t seed3_len,u8 * res,size_t res_len)2316d49e1aeSJan Lentfer static void prf_prime(const u8 *k, const char *seed1,
2326d49e1aeSJan Lentfer 		      const u8 *seed2, size_t seed2_len,
2336d49e1aeSJan Lentfer 		      const u8 *seed3, size_t seed3_len,
2346d49e1aeSJan Lentfer 		      u8 *res, size_t res_len)
2356d49e1aeSJan Lentfer {
2366d49e1aeSJan Lentfer 	const u8 *addr[5];
2376d49e1aeSJan Lentfer 	size_t len[5];
2386d49e1aeSJan Lentfer 	u8 hash[SHA256_MAC_LEN];
2396d49e1aeSJan Lentfer 	u8 iter;
2406d49e1aeSJan Lentfer 
2416d49e1aeSJan Lentfer 	/*
2426d49e1aeSJan Lentfer 	 * PRF'(K,S) = T1 | T2 | T3 | T4 | ...
2436d49e1aeSJan Lentfer 	 * T1 = HMAC-SHA-256 (K, S | 0x01)
2446d49e1aeSJan Lentfer 	 * T2 = HMAC-SHA-256 (K, T1 | S | 0x02)
2456d49e1aeSJan Lentfer 	 * T3 = HMAC-SHA-256 (K, T2 | S | 0x03)
2466d49e1aeSJan Lentfer 	 * T4 = HMAC-SHA-256 (K, T3 | S | 0x04)
2476d49e1aeSJan Lentfer 	 * ...
2486d49e1aeSJan Lentfer 	 */
2496d49e1aeSJan Lentfer 
2506d49e1aeSJan Lentfer 	addr[0] = hash;
2516d49e1aeSJan Lentfer 	len[0] = 0;
2526d49e1aeSJan Lentfer 	addr[1] = (const u8 *) seed1;
2536d49e1aeSJan Lentfer 	len[1] = os_strlen(seed1);
2546d49e1aeSJan Lentfer 	addr[2] = seed2;
2556d49e1aeSJan Lentfer 	len[2] = seed2_len;
2566d49e1aeSJan Lentfer 	addr[3] = seed3;
2576d49e1aeSJan Lentfer 	len[3] = seed3_len;
2586d49e1aeSJan Lentfer 	addr[4] = &iter;
2596d49e1aeSJan Lentfer 	len[4] = 1;
2606d49e1aeSJan Lentfer 
2616d49e1aeSJan Lentfer 	iter = 0;
2626d49e1aeSJan Lentfer 	while (res_len) {
2636d49e1aeSJan Lentfer 		size_t hlen;
2646d49e1aeSJan Lentfer 		iter++;
2656d49e1aeSJan Lentfer 		hmac_sha256_vector(k, 32, 5, addr, len, hash);
2666d49e1aeSJan Lentfer 		len[0] = SHA256_MAC_LEN;
2676d49e1aeSJan Lentfer 		hlen = res_len > SHA256_MAC_LEN ? SHA256_MAC_LEN : res_len;
2686d49e1aeSJan Lentfer 		os_memcpy(res, hash, hlen);
2696d49e1aeSJan Lentfer 		res += hlen;
2706d49e1aeSJan Lentfer 		res_len -= hlen;
2716d49e1aeSJan Lentfer 	}
2726d49e1aeSJan Lentfer }
2736d49e1aeSJan Lentfer 
2746d49e1aeSJan Lentfer 
eap_aka_prime_derive_keys(const u8 * identity,size_t identity_len,const u8 * ik,const u8 * ck,u8 * k_encr,u8 * k_aut,u8 * k_re,u8 * msk,u8 * emsk)2756d49e1aeSJan Lentfer void eap_aka_prime_derive_keys(const u8 *identity, size_t identity_len,
2766d49e1aeSJan Lentfer 			       const u8 *ik, const u8 *ck, u8 *k_encr,
2776d49e1aeSJan Lentfer 			       u8 *k_aut, u8 *k_re, u8 *msk, u8 *emsk)
2786d49e1aeSJan Lentfer {
2796d49e1aeSJan Lentfer 	u8 key[EAP_AKA_IK_LEN + EAP_AKA_CK_LEN];
2806d49e1aeSJan Lentfer 	u8 keys[EAP_SIM_K_ENCR_LEN + EAP_AKA_PRIME_K_AUT_LEN +
2816d49e1aeSJan Lentfer 		EAP_AKA_PRIME_K_RE_LEN + EAP_MSK_LEN + EAP_EMSK_LEN];
2826d49e1aeSJan Lentfer 	u8 *pos;
2836d49e1aeSJan Lentfer 
2846d49e1aeSJan Lentfer 	/*
2856d49e1aeSJan Lentfer 	 * MK = PRF'(IK'|CK',"EAP-AKA'"|Identity)
2866d49e1aeSJan Lentfer 	 * K_encr = MK[0..127]
2876d49e1aeSJan Lentfer 	 * K_aut  = MK[128..383]
2886d49e1aeSJan Lentfer 	 * K_re   = MK[384..639]
2896d49e1aeSJan Lentfer 	 * MSK    = MK[640..1151]
2906d49e1aeSJan Lentfer 	 * EMSK   = MK[1152..1663]
2916d49e1aeSJan Lentfer 	 */
2926d49e1aeSJan Lentfer 
2936d49e1aeSJan Lentfer 	os_memcpy(key, ik, EAP_AKA_IK_LEN);
2946d49e1aeSJan Lentfer 	os_memcpy(key + EAP_AKA_IK_LEN, ck, EAP_AKA_CK_LEN);
2956d49e1aeSJan Lentfer 
2966d49e1aeSJan Lentfer 	prf_prime(key, "EAP-AKA'", identity, identity_len, NULL, 0,
2976d49e1aeSJan Lentfer 		  keys, sizeof(keys));
2986d49e1aeSJan Lentfer 
2996d49e1aeSJan Lentfer 	pos = keys;
3006d49e1aeSJan Lentfer 	os_memcpy(k_encr, pos, EAP_SIM_K_ENCR_LEN);
3016d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': K_encr",
3026d49e1aeSJan Lentfer 			k_encr, EAP_SIM_K_ENCR_LEN);
3036d49e1aeSJan Lentfer 	pos += EAP_SIM_K_ENCR_LEN;
3046d49e1aeSJan Lentfer 
3056d49e1aeSJan Lentfer 	os_memcpy(k_aut, pos, EAP_AKA_PRIME_K_AUT_LEN);
3066d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': K_aut",
3076d49e1aeSJan Lentfer 			k_aut, EAP_AKA_PRIME_K_AUT_LEN);
3086d49e1aeSJan Lentfer 	pos += EAP_AKA_PRIME_K_AUT_LEN;
3096d49e1aeSJan Lentfer 
3106d49e1aeSJan Lentfer 	os_memcpy(k_re, pos, EAP_AKA_PRIME_K_RE_LEN);
3116d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': K_re",
3126d49e1aeSJan Lentfer 			k_re, EAP_AKA_PRIME_K_RE_LEN);
3136d49e1aeSJan Lentfer 	pos += EAP_AKA_PRIME_K_RE_LEN;
3146d49e1aeSJan Lentfer 
3156d49e1aeSJan Lentfer 	os_memcpy(msk, pos, EAP_MSK_LEN);
3166d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': MSK", msk, EAP_MSK_LEN);
3176d49e1aeSJan Lentfer 	pos += EAP_MSK_LEN;
3186d49e1aeSJan Lentfer 
3196d49e1aeSJan Lentfer 	os_memcpy(emsk, pos, EAP_EMSK_LEN);
3206d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': EMSK", emsk, EAP_EMSK_LEN);
3216d49e1aeSJan Lentfer }
3226d49e1aeSJan Lentfer 
3236d49e1aeSJan Lentfer 
eap_aka_prime_derive_keys_reauth(const u8 * k_re,u16 counter,const u8 * identity,size_t identity_len,const u8 * nonce_s,u8 * msk,u8 * emsk)3246d49e1aeSJan Lentfer int eap_aka_prime_derive_keys_reauth(const u8 *k_re, u16 counter,
3256d49e1aeSJan Lentfer 				     const u8 *identity, size_t identity_len,
3266d49e1aeSJan Lentfer 				     const u8 *nonce_s, u8 *msk, u8 *emsk)
3276d49e1aeSJan Lentfer {
3286d49e1aeSJan Lentfer 	u8 seed3[2 + EAP_SIM_NONCE_S_LEN];
3296d49e1aeSJan Lentfer 	u8 keys[EAP_MSK_LEN + EAP_EMSK_LEN];
3306d49e1aeSJan Lentfer 	u8 *pos;
3316d49e1aeSJan Lentfer 
3326d49e1aeSJan Lentfer 	/*
3336d49e1aeSJan Lentfer 	 * MK = PRF'(K_re,"EAP-AKA' re-auth"|Identity|counter|NONCE_S)
3346d49e1aeSJan Lentfer 	 * MSK  = MK[0..511]
3356d49e1aeSJan Lentfer 	 * EMSK = MK[512..1023]
3366d49e1aeSJan Lentfer 	 */
3376d49e1aeSJan Lentfer 
3386d49e1aeSJan Lentfer 	WPA_PUT_BE16(seed3, counter);
3396d49e1aeSJan Lentfer 	os_memcpy(seed3 + 2, nonce_s, EAP_SIM_NONCE_S_LEN);
3406d49e1aeSJan Lentfer 
3416d49e1aeSJan Lentfer 	prf_prime(k_re, "EAP-AKA' re-auth", identity, identity_len,
3426d49e1aeSJan Lentfer 		  seed3, sizeof(seed3),
3436d49e1aeSJan Lentfer 		  keys, sizeof(keys));
3446d49e1aeSJan Lentfer 
3456d49e1aeSJan Lentfer 	pos = keys;
3466d49e1aeSJan Lentfer 	os_memcpy(msk, pos, EAP_MSK_LEN);
3476d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': MSK", msk, EAP_MSK_LEN);
3486d49e1aeSJan Lentfer 	pos += EAP_MSK_LEN;
3496d49e1aeSJan Lentfer 
3506d49e1aeSJan Lentfer 	os_memcpy(emsk, pos, EAP_EMSK_LEN);
3516d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': EMSK", emsk, EAP_EMSK_LEN);
3526d49e1aeSJan Lentfer 
3536d49e1aeSJan Lentfer 	os_memset(keys, 0, sizeof(keys));
3546d49e1aeSJan Lentfer 
3556d49e1aeSJan Lentfer 	return 0;
3566d49e1aeSJan Lentfer }
3576d49e1aeSJan Lentfer 
3586d49e1aeSJan Lentfer 
eap_sim_verify_mac_sha256(const u8 * k_aut,const struct wpabuf * req,const u8 * mac,const u8 * extra,size_t extra_len)3596d49e1aeSJan Lentfer int eap_sim_verify_mac_sha256(const u8 *k_aut, const struct wpabuf *req,
3606d49e1aeSJan Lentfer 			      const u8 *mac, const u8 *extra, size_t extra_len)
3616d49e1aeSJan Lentfer {
3626d49e1aeSJan Lentfer 	unsigned char hmac[SHA256_MAC_LEN];
3636d49e1aeSJan Lentfer 	const u8 *addr[2];
3646d49e1aeSJan Lentfer 	size_t len[2];
3656d49e1aeSJan Lentfer 	u8 *tmp;
3666d49e1aeSJan Lentfer 
3676d49e1aeSJan Lentfer 	if (mac == NULL || wpabuf_len(req) < EAP_SIM_MAC_LEN ||
3686d49e1aeSJan Lentfer 	    mac < wpabuf_head_u8(req) ||
3696d49e1aeSJan Lentfer 	    mac > wpabuf_head_u8(req) + wpabuf_len(req) - EAP_SIM_MAC_LEN)
3706d49e1aeSJan Lentfer 		return -1;
3716d49e1aeSJan Lentfer 
372*a1157835SDaniel Fojt 	tmp = os_memdup(wpabuf_head(req), wpabuf_len(req));
3736d49e1aeSJan Lentfer 	if (tmp == NULL)
3746d49e1aeSJan Lentfer 		return -1;
3756d49e1aeSJan Lentfer 
3766d49e1aeSJan Lentfer 	addr[0] = tmp;
3776d49e1aeSJan Lentfer 	len[0] = wpabuf_len(req);
3786d49e1aeSJan Lentfer 	addr[1] = extra;
3796d49e1aeSJan Lentfer 	len[1] = extra_len;
3806d49e1aeSJan Lentfer 
3816d49e1aeSJan Lentfer 	/* HMAC-SHA-256-128 */
3826d49e1aeSJan Lentfer 	os_memset(tmp + (mac - wpabuf_head_u8(req)), 0, EAP_SIM_MAC_LEN);
3836d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-AKA': Verify MAC - msg",
3846d49e1aeSJan Lentfer 		    tmp, wpabuf_len(req));
3856d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-AKA': Verify MAC - extra data",
3866d49e1aeSJan Lentfer 		    extra, extra_len);
3876d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_MSGDUMP, "EAP-AKA': Verify MAC - K_aut",
3886d49e1aeSJan Lentfer 			k_aut, EAP_AKA_PRIME_K_AUT_LEN);
3896d49e1aeSJan Lentfer 	hmac_sha256_vector(k_aut, EAP_AKA_PRIME_K_AUT_LEN, 2, addr, len, hmac);
3906d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-AKA': Verify MAC: MAC",
3916d49e1aeSJan Lentfer 		    hmac, EAP_SIM_MAC_LEN);
3926d49e1aeSJan Lentfer 	os_free(tmp);
3936d49e1aeSJan Lentfer 
394*a1157835SDaniel Fojt 	return (os_memcmp_const(hmac, mac, EAP_SIM_MAC_LEN) == 0) ? 0 : 1;
3956d49e1aeSJan Lentfer }
3966d49e1aeSJan Lentfer 
3976d49e1aeSJan Lentfer 
eap_sim_add_mac_sha256(const u8 * k_aut,const u8 * msg,size_t msg_len,u8 * mac,const u8 * extra,size_t extra_len)3986d49e1aeSJan Lentfer void eap_sim_add_mac_sha256(const u8 *k_aut, const u8 *msg, size_t msg_len,
3996d49e1aeSJan Lentfer 			    u8 *mac, const u8 *extra, size_t extra_len)
4006d49e1aeSJan Lentfer {
4016d49e1aeSJan Lentfer 	unsigned char hmac[SHA256_MAC_LEN];
4026d49e1aeSJan Lentfer 	const u8 *addr[2];
4036d49e1aeSJan Lentfer 	size_t len[2];
4046d49e1aeSJan Lentfer 
4056d49e1aeSJan Lentfer 	addr[0] = msg;
4066d49e1aeSJan Lentfer 	len[0] = msg_len;
4076d49e1aeSJan Lentfer 	addr[1] = extra;
4086d49e1aeSJan Lentfer 	len[1] = extra_len;
4096d49e1aeSJan Lentfer 
4106d49e1aeSJan Lentfer 	/* HMAC-SHA-256-128 */
4116d49e1aeSJan Lentfer 	os_memset(mac, 0, EAP_SIM_MAC_LEN);
4126d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-AKA': Add MAC - msg", msg, msg_len);
4136d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-AKA': Add MAC - extra data",
4146d49e1aeSJan Lentfer 		    extra, extra_len);
4156d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_MSGDUMP, "EAP-AKA': Add MAC - K_aut",
4166d49e1aeSJan Lentfer 			k_aut, EAP_AKA_PRIME_K_AUT_LEN);
4176d49e1aeSJan Lentfer 	hmac_sha256_vector(k_aut, EAP_AKA_PRIME_K_AUT_LEN, 2, addr, len, hmac);
4186d49e1aeSJan Lentfer 	os_memcpy(mac, hmac, EAP_SIM_MAC_LEN);
4196d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-AKA': Add MAC: MAC",
4206d49e1aeSJan Lentfer 		    mac, EAP_SIM_MAC_LEN);
4216d49e1aeSJan Lentfer }
4226d49e1aeSJan Lentfer 
4236d49e1aeSJan Lentfer 
eap_aka_prime_derive_ck_ik_prime(u8 * ck,u8 * ik,const u8 * sqn_ak,const u8 * network_name,size_t network_name_len)4246d49e1aeSJan Lentfer void eap_aka_prime_derive_ck_ik_prime(u8 *ck, u8 *ik, const u8 *sqn_ak,
4256d49e1aeSJan Lentfer 				      const u8 *network_name,
4266d49e1aeSJan Lentfer 				      size_t network_name_len)
4276d49e1aeSJan Lentfer {
4286d49e1aeSJan Lentfer 	u8 key[EAP_AKA_CK_LEN + EAP_AKA_IK_LEN];
4296d49e1aeSJan Lentfer 	u8 hash[SHA256_MAC_LEN];
4306d49e1aeSJan Lentfer 	const u8 *addr[5];
4316d49e1aeSJan Lentfer 	size_t len[5];
4326d49e1aeSJan Lentfer 	u8 fc;
4336d49e1aeSJan Lentfer 	u8 l0[2], l1[2];
4346d49e1aeSJan Lentfer 
4356d49e1aeSJan Lentfer 	/* 3GPP TS 33.402 V8.0.0
4366d49e1aeSJan Lentfer 	 * (CK', IK') = F(CK, IK, <access network identity>)
4376d49e1aeSJan Lentfer 	 */
4386d49e1aeSJan Lentfer 	/* TODO: CK', IK' generation should really be moved into the actual
4396d49e1aeSJan Lentfer 	 * AKA procedure with network name passed in there and option to use
4406d49e1aeSJan Lentfer 	 * AMF separation bit = 1 (3GPP TS 33.401). */
4416d49e1aeSJan Lentfer 
4426d49e1aeSJan Lentfer 	/* Change Request 33.402 CR 0033 to version 8.1.1 from
4436d49e1aeSJan Lentfer 	 * 3GPP TSG-SA WG3 Meeting #53 in September 2008:
4446d49e1aeSJan Lentfer 	 *
4456d49e1aeSJan Lentfer 	 * CK' || IK' = HMAC-SHA-256(Key, S)
4466d49e1aeSJan Lentfer 	 * S = FC || P0 || L0 || P1 || L1 || ... || Pn || Ln
4476d49e1aeSJan Lentfer 	 * Key = CK || IK
4486d49e1aeSJan Lentfer 	 * FC = 0x20
4496d49e1aeSJan Lentfer 	 * P0 = access network identity (3GPP TS 24.302)
4506d49e1aeSJan Lentfer 	 * L0 = length of acceess network identity (2 octets, big endian)
4516d49e1aeSJan Lentfer 	 * P1 = SQN xor AK (if AK is not used, AK is treaded as 000..0
4526d49e1aeSJan Lentfer 	 * L1 = 0x00 0x06
4536d49e1aeSJan Lentfer 	 */
4546d49e1aeSJan Lentfer 
4556d49e1aeSJan Lentfer 	fc = 0x20;
4566d49e1aeSJan Lentfer 
4576d49e1aeSJan Lentfer 	wpa_printf(MSG_DEBUG, "EAP-AKA': Derive (CK',IK') from (CK,IK)");
4586d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': CK", ck, EAP_AKA_CK_LEN);
4596d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': IK", ik, EAP_AKA_IK_LEN);
4606d49e1aeSJan Lentfer 	wpa_printf(MSG_DEBUG, "EAP-AKA': FC = 0x%x", fc);
4616d49e1aeSJan Lentfer 	wpa_hexdump_ascii(MSG_DEBUG, "EAP-AKA': P0 = Access network identity",
4626d49e1aeSJan Lentfer 			  network_name, network_name_len);
4636d49e1aeSJan Lentfer 	wpa_hexdump(MSG_DEBUG, "EAP-AKA': P1 = SQN xor AK", sqn_ak, 6);
4646d49e1aeSJan Lentfer 
4656d49e1aeSJan Lentfer 	os_memcpy(key, ck, EAP_AKA_CK_LEN);
4666d49e1aeSJan Lentfer 	os_memcpy(key + EAP_AKA_CK_LEN, ik, EAP_AKA_IK_LEN);
4676d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': Key = CK || IK",
4686d49e1aeSJan Lentfer 			key, sizeof(key));
4696d49e1aeSJan Lentfer 
4706d49e1aeSJan Lentfer 	addr[0] = &fc;
4716d49e1aeSJan Lentfer 	len[0] = 1;
4726d49e1aeSJan Lentfer 	addr[1] = network_name;
4736d49e1aeSJan Lentfer 	len[1] = network_name_len;
4746d49e1aeSJan Lentfer 	WPA_PUT_BE16(l0, network_name_len);
4756d49e1aeSJan Lentfer 	addr[2] = l0;
4766d49e1aeSJan Lentfer 	len[2] = 2;
4776d49e1aeSJan Lentfer 	addr[3] = sqn_ak;
4786d49e1aeSJan Lentfer 	len[3] = 6;
4796d49e1aeSJan Lentfer 	WPA_PUT_BE16(l1, 6);
4806d49e1aeSJan Lentfer 	addr[4] = l1;
4816d49e1aeSJan Lentfer 	len[4] = 2;
4826d49e1aeSJan Lentfer 
4836d49e1aeSJan Lentfer 	hmac_sha256_vector(key, sizeof(key), 5, addr, len, hash);
4846d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': KDF output (CK' || IK')",
4856d49e1aeSJan Lentfer 			hash, sizeof(hash));
4866d49e1aeSJan Lentfer 
4876d49e1aeSJan Lentfer 	os_memcpy(ck, hash, EAP_AKA_CK_LEN);
4886d49e1aeSJan Lentfer 	os_memcpy(ik, hash + EAP_AKA_CK_LEN, EAP_AKA_IK_LEN);
4896d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': CK'", ck, EAP_AKA_CK_LEN);
4906d49e1aeSJan Lentfer 	wpa_hexdump_key(MSG_DEBUG, "EAP-AKA': IK'", ik, EAP_AKA_IK_LEN);
4916d49e1aeSJan Lentfer }
4923ff40c12SJohn Marino #endif /* EAP_AKA_PRIME || EAP_SERVER_AKA_PRIME */
4936d49e1aeSJan Lentfer 
4946d49e1aeSJan Lentfer 
eap_sim_parse_attr(const u8 * start,const u8 * end,struct eap_sim_attrs * attr,int aka,int encr)4956d49e1aeSJan Lentfer int eap_sim_parse_attr(const u8 *start, const u8 *end,
4966d49e1aeSJan Lentfer 		       struct eap_sim_attrs *attr, int aka, int encr)
4976d49e1aeSJan Lentfer {
4986d49e1aeSJan Lentfer 	const u8 *pos = start, *apos;
4996d49e1aeSJan Lentfer 	size_t alen, plen, i, list_len;
5006d49e1aeSJan Lentfer 
5016d49e1aeSJan Lentfer 	os_memset(attr, 0, sizeof(*attr));
5026d49e1aeSJan Lentfer 	attr->id_req = NO_ID_REQ;
5036d49e1aeSJan Lentfer 	attr->notification = -1;
5046d49e1aeSJan Lentfer 	attr->counter = -1;
5056d49e1aeSJan Lentfer 	attr->selected_version = -1;
5066d49e1aeSJan Lentfer 	attr->client_error_code = -1;
5076d49e1aeSJan Lentfer 
5086d49e1aeSJan Lentfer 	while (pos < end) {
5096d49e1aeSJan Lentfer 		if (pos + 2 > end) {
5106d49e1aeSJan Lentfer 			wpa_printf(MSG_INFO, "EAP-SIM: Attribute overflow(1)");
5116d49e1aeSJan Lentfer 			return -1;
5126d49e1aeSJan Lentfer 		}
5136d49e1aeSJan Lentfer 		wpa_printf(MSG_MSGDUMP, "EAP-SIM: Attribute: Type=%d Len=%d",
5146d49e1aeSJan Lentfer 			   pos[0], pos[1] * 4);
5156d49e1aeSJan Lentfer 		if (pos + pos[1] * 4 > end) {
5166d49e1aeSJan Lentfer 			wpa_printf(MSG_INFO, "EAP-SIM: Attribute overflow "
5176d49e1aeSJan Lentfer 				   "(pos=%p len=%d end=%p)",
5186d49e1aeSJan Lentfer 				   pos, pos[1] * 4, end);
5196d49e1aeSJan Lentfer 			return -1;
5206d49e1aeSJan Lentfer 		}
5216d49e1aeSJan Lentfer 		if (pos[1] == 0) {
5226d49e1aeSJan Lentfer 			wpa_printf(MSG_INFO, "EAP-SIM: Attribute underflow");
5236d49e1aeSJan Lentfer 			return -1;
5246d49e1aeSJan Lentfer 		}
5256d49e1aeSJan Lentfer 		apos = pos + 2;
5266d49e1aeSJan Lentfer 		alen = pos[1] * 4 - 2;
5276d49e1aeSJan Lentfer 		wpa_hexdump(MSG_MSGDUMP, "EAP-SIM: Attribute data",
5286d49e1aeSJan Lentfer 			    apos, alen);
5296d49e1aeSJan Lentfer 
5306d49e1aeSJan Lentfer 		switch (pos[0]) {
5316d49e1aeSJan Lentfer 		case EAP_SIM_AT_RAND:
5326d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_RAND");
5336d49e1aeSJan Lentfer 			apos += 2;
5346d49e1aeSJan Lentfer 			alen -= 2;
5356d49e1aeSJan Lentfer 			if ((!aka && (alen % GSM_RAND_LEN)) ||
5366d49e1aeSJan Lentfer 			    (aka && alen != EAP_AKA_RAND_LEN)) {
5376d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid AT_RAND"
5386d49e1aeSJan Lentfer 					   " (len %lu)",
5396d49e1aeSJan Lentfer 					   (unsigned long) alen);
5406d49e1aeSJan Lentfer 				return -1;
5416d49e1aeSJan Lentfer 			}
5426d49e1aeSJan Lentfer 			attr->rand = apos;
5436d49e1aeSJan Lentfer 			attr->num_chal = alen / GSM_RAND_LEN;
5446d49e1aeSJan Lentfer 			break;
5456d49e1aeSJan Lentfer 		case EAP_SIM_AT_AUTN:
5466d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-AKA: AT_AUTN");
5476d49e1aeSJan Lentfer 			if (!aka) {
5486d49e1aeSJan Lentfer 				wpa_printf(MSG_DEBUG, "EAP-SIM: "
5496d49e1aeSJan Lentfer 					   "Unexpected AT_AUTN");
5506d49e1aeSJan Lentfer 				return -1;
5516d49e1aeSJan Lentfer 			}
5526d49e1aeSJan Lentfer 			apos += 2;
5536d49e1aeSJan Lentfer 			alen -= 2;
5546d49e1aeSJan Lentfer 			if (alen != EAP_AKA_AUTN_LEN) {
5556d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-AKA: Invalid AT_AUTN"
5566d49e1aeSJan Lentfer 					   " (len %lu)",
5576d49e1aeSJan Lentfer 					   (unsigned long) alen);
5586d49e1aeSJan Lentfer 				return -1;
5596d49e1aeSJan Lentfer 			}
5606d49e1aeSJan Lentfer 			attr->autn = apos;
5616d49e1aeSJan Lentfer 			break;
5626d49e1aeSJan Lentfer 		case EAP_SIM_AT_PADDING:
5636d49e1aeSJan Lentfer 			if (!encr) {
5646d49e1aeSJan Lentfer 				wpa_printf(MSG_ERROR, "EAP-SIM: Unencrypted "
5656d49e1aeSJan Lentfer 					   "AT_PADDING");
5666d49e1aeSJan Lentfer 				return -1;
5676d49e1aeSJan Lentfer 			}
5686d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: (encr) AT_PADDING");
5696d49e1aeSJan Lentfer 			for (i = 2; i < alen; i++) {
5706d49e1aeSJan Lentfer 				if (apos[i] != 0) {
5716d49e1aeSJan Lentfer 					wpa_printf(MSG_INFO, "EAP-SIM: (encr) "
5726d49e1aeSJan Lentfer 						   "AT_PADDING used a non-zero"
5736d49e1aeSJan Lentfer 						   " padding byte");
5746d49e1aeSJan Lentfer 					wpa_hexdump(MSG_DEBUG, "EAP-SIM: "
5756d49e1aeSJan Lentfer 						    "(encr) padding bytes",
5766d49e1aeSJan Lentfer 						    apos + 2, alen - 2);
5776d49e1aeSJan Lentfer 					return -1;
5786d49e1aeSJan Lentfer 				}
5796d49e1aeSJan Lentfer 			}
5806d49e1aeSJan Lentfer 			break;
5816d49e1aeSJan Lentfer 		case EAP_SIM_AT_NONCE_MT:
5826d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_NONCE_MT");
5836d49e1aeSJan Lentfer 			if (alen != 2 + EAP_SIM_NONCE_MT_LEN) {
5846d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid "
5856d49e1aeSJan Lentfer 					   "AT_NONCE_MT length");
5866d49e1aeSJan Lentfer 				return -1;
5876d49e1aeSJan Lentfer 			}
5886d49e1aeSJan Lentfer 			attr->nonce_mt = apos + 2;
5896d49e1aeSJan Lentfer 			break;
5906d49e1aeSJan Lentfer 		case EAP_SIM_AT_PERMANENT_ID_REQ:
5916d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_PERMANENT_ID_REQ");
5926d49e1aeSJan Lentfer 			attr->id_req = PERMANENT_ID;
5936d49e1aeSJan Lentfer 			break;
5946d49e1aeSJan Lentfer 		case EAP_SIM_AT_MAC:
5956d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_MAC");
5966d49e1aeSJan Lentfer 			if (alen != 2 + EAP_SIM_MAC_LEN) {
5976d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid AT_MAC "
5986d49e1aeSJan Lentfer 					   "length");
5996d49e1aeSJan Lentfer 				return -1;
6006d49e1aeSJan Lentfer 			}
6016d49e1aeSJan Lentfer 			attr->mac = apos + 2;
6026d49e1aeSJan Lentfer 			break;
6036d49e1aeSJan Lentfer 		case EAP_SIM_AT_NOTIFICATION:
6046d49e1aeSJan Lentfer 			if (alen != 2) {
6056d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid "
6066d49e1aeSJan Lentfer 					   "AT_NOTIFICATION length %lu",
6076d49e1aeSJan Lentfer 					   (unsigned long) alen);
6086d49e1aeSJan Lentfer 				return -1;
6096d49e1aeSJan Lentfer 			}
6106d49e1aeSJan Lentfer 			attr->notification = apos[0] * 256 + apos[1];
6116d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_NOTIFICATION %d",
6126d49e1aeSJan Lentfer 				   attr->notification);
6136d49e1aeSJan Lentfer 			break;
6146d49e1aeSJan Lentfer 		case EAP_SIM_AT_ANY_ID_REQ:
6156d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_ANY_ID_REQ");
6166d49e1aeSJan Lentfer 			attr->id_req = ANY_ID;
6176d49e1aeSJan Lentfer 			break;
6186d49e1aeSJan Lentfer 		case EAP_SIM_AT_IDENTITY:
6196d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_IDENTITY");
6206d49e1aeSJan Lentfer 			plen = WPA_GET_BE16(apos);
6216d49e1aeSJan Lentfer 			apos += 2;
6226d49e1aeSJan Lentfer 			alen -= 2;
6236d49e1aeSJan Lentfer 			if (plen > alen) {
6246d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid "
6256d49e1aeSJan Lentfer 					   "AT_IDENTITY (Actual Length %lu, "
6266d49e1aeSJan Lentfer 					   "remaining length %lu)",
6276d49e1aeSJan Lentfer 					   (unsigned long) plen,
6286d49e1aeSJan Lentfer 					   (unsigned long) alen);
6296d49e1aeSJan Lentfer 				return -1;
6306d49e1aeSJan Lentfer 			}
6316d49e1aeSJan Lentfer 
6326d49e1aeSJan Lentfer 			attr->identity = apos;
6336d49e1aeSJan Lentfer 			attr->identity_len = plen;
6346d49e1aeSJan Lentfer 			break;
6356d49e1aeSJan Lentfer 		case EAP_SIM_AT_VERSION_LIST:
6366d49e1aeSJan Lentfer 			if (aka) {
6376d49e1aeSJan Lentfer 				wpa_printf(MSG_DEBUG, "EAP-AKA: "
6386d49e1aeSJan Lentfer 					   "Unexpected AT_VERSION_LIST");
6396d49e1aeSJan Lentfer 				return -1;
6406d49e1aeSJan Lentfer 			}
6416d49e1aeSJan Lentfer 			list_len = apos[0] * 256 + apos[1];
6426d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_VERSION_LIST");
6436d49e1aeSJan Lentfer 			if (list_len < 2 || list_len > alen - 2) {
6446d49e1aeSJan Lentfer 				wpa_printf(MSG_WARNING, "EAP-SIM: Invalid "
6456d49e1aeSJan Lentfer 					   "AT_VERSION_LIST (list_len=%lu "
6466d49e1aeSJan Lentfer 					   "attr_len=%lu)",
6476d49e1aeSJan Lentfer 					   (unsigned long) list_len,
6486d49e1aeSJan Lentfer 					   (unsigned long) alen);
6496d49e1aeSJan Lentfer 				return -1;
6506d49e1aeSJan Lentfer 			}
6516d49e1aeSJan Lentfer 			attr->version_list = apos + 2;
6526d49e1aeSJan Lentfer 			attr->version_list_len = list_len;
6536d49e1aeSJan Lentfer 			break;
6546d49e1aeSJan Lentfer 		case EAP_SIM_AT_SELECTED_VERSION:
6556d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_SELECTED_VERSION");
6566d49e1aeSJan Lentfer 			if (alen != 2) {
6576d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid "
6586d49e1aeSJan Lentfer 					   "AT_SELECTED_VERSION length %lu",
6596d49e1aeSJan Lentfer 					   (unsigned long) alen);
6606d49e1aeSJan Lentfer 				return -1;
6616d49e1aeSJan Lentfer 			}
6626d49e1aeSJan Lentfer 			attr->selected_version = apos[0] * 256 + apos[1];
6636d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_SELECTED_VERSION "
6646d49e1aeSJan Lentfer 				   "%d", attr->selected_version);
6656d49e1aeSJan Lentfer 			break;
6666d49e1aeSJan Lentfer 		case EAP_SIM_AT_FULLAUTH_ID_REQ:
6676d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_FULLAUTH_ID_REQ");
6686d49e1aeSJan Lentfer 			attr->id_req = FULLAUTH_ID;
6696d49e1aeSJan Lentfer 			break;
6706d49e1aeSJan Lentfer 		case EAP_SIM_AT_COUNTER:
6716d49e1aeSJan Lentfer 			if (!encr) {
6726d49e1aeSJan Lentfer 				wpa_printf(MSG_ERROR, "EAP-SIM: Unencrypted "
6736d49e1aeSJan Lentfer 					   "AT_COUNTER");
6746d49e1aeSJan Lentfer 				return -1;
6756d49e1aeSJan Lentfer 			}
6766d49e1aeSJan Lentfer 			if (alen != 2) {
6776d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: (encr) Invalid "
6786d49e1aeSJan Lentfer 					   "AT_COUNTER (alen=%lu)",
6796d49e1aeSJan Lentfer 					   (unsigned long) alen);
6806d49e1aeSJan Lentfer 				return -1;
6816d49e1aeSJan Lentfer 			}
6826d49e1aeSJan Lentfer 			attr->counter = apos[0] * 256 + apos[1];
6836d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: (encr) AT_COUNTER %d",
6846d49e1aeSJan Lentfer 				   attr->counter);
6856d49e1aeSJan Lentfer 			break;
6866d49e1aeSJan Lentfer 		case EAP_SIM_AT_COUNTER_TOO_SMALL:
6876d49e1aeSJan Lentfer 			if (!encr) {
6886d49e1aeSJan Lentfer 				wpa_printf(MSG_ERROR, "EAP-SIM: Unencrypted "
6896d49e1aeSJan Lentfer 					   "AT_COUNTER_TOO_SMALL");
6906d49e1aeSJan Lentfer 				return -1;
6916d49e1aeSJan Lentfer 			}
6926d49e1aeSJan Lentfer 			if (alen != 2) {
6936d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: (encr) Invalid "
6946d49e1aeSJan Lentfer 					   "AT_COUNTER_TOO_SMALL (alen=%lu)",
6956d49e1aeSJan Lentfer 					   (unsigned long) alen);
6966d49e1aeSJan Lentfer 				return -1;
6976d49e1aeSJan Lentfer 			}
6986d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: (encr) "
6996d49e1aeSJan Lentfer 				   "AT_COUNTER_TOO_SMALL");
7006d49e1aeSJan Lentfer 			attr->counter_too_small = 1;
7016d49e1aeSJan Lentfer 			break;
7026d49e1aeSJan Lentfer 		case EAP_SIM_AT_NONCE_S:
7036d49e1aeSJan Lentfer 			if (!encr) {
7046d49e1aeSJan Lentfer 				wpa_printf(MSG_ERROR, "EAP-SIM: Unencrypted "
7056d49e1aeSJan Lentfer 					   "AT_NONCE_S");
7066d49e1aeSJan Lentfer 				return -1;
7076d49e1aeSJan Lentfer 			}
7086d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: (encr) "
7096d49e1aeSJan Lentfer 				   "AT_NONCE_S");
7106d49e1aeSJan Lentfer 			if (alen != 2 + EAP_SIM_NONCE_S_LEN) {
7116d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: (encr) Invalid "
7126d49e1aeSJan Lentfer 					   "AT_NONCE_S (alen=%lu)",
7136d49e1aeSJan Lentfer 					   (unsigned long) alen);
7146d49e1aeSJan Lentfer 				return -1;
7156d49e1aeSJan Lentfer 			}
7166d49e1aeSJan Lentfer 			attr->nonce_s = apos + 2;
7176d49e1aeSJan Lentfer 			break;
7186d49e1aeSJan Lentfer 		case EAP_SIM_AT_CLIENT_ERROR_CODE:
7196d49e1aeSJan Lentfer 			if (alen != 2) {
7206d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid "
7216d49e1aeSJan Lentfer 					   "AT_CLIENT_ERROR_CODE length %lu",
7226d49e1aeSJan Lentfer 					   (unsigned long) alen);
7236d49e1aeSJan Lentfer 				return -1;
7246d49e1aeSJan Lentfer 			}
7256d49e1aeSJan Lentfer 			attr->client_error_code = apos[0] * 256 + apos[1];
7266d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_CLIENT_ERROR_CODE "
7276d49e1aeSJan Lentfer 				   "%d", attr->client_error_code);
7286d49e1aeSJan Lentfer 			break;
7296d49e1aeSJan Lentfer 		case EAP_SIM_AT_IV:
7306d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_IV");
7316d49e1aeSJan Lentfer 			if (alen != 2 + EAP_SIM_MAC_LEN) {
7326d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid AT_IV "
7336d49e1aeSJan Lentfer 					   "length %lu", (unsigned long) alen);
7346d49e1aeSJan Lentfer 				return -1;
7356d49e1aeSJan Lentfer 			}
7366d49e1aeSJan Lentfer 			attr->iv = apos + 2;
7376d49e1aeSJan Lentfer 			break;
7386d49e1aeSJan Lentfer 		case EAP_SIM_AT_ENCR_DATA:
7396d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_ENCR_DATA");
7406d49e1aeSJan Lentfer 			attr->encr_data = apos + 2;
7416d49e1aeSJan Lentfer 			attr->encr_data_len = alen - 2;
7426d49e1aeSJan Lentfer 			if (attr->encr_data_len % 16) {
7436d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid "
7446d49e1aeSJan Lentfer 					   "AT_ENCR_DATA length %lu",
7456d49e1aeSJan Lentfer 					   (unsigned long)
7466d49e1aeSJan Lentfer 					   attr->encr_data_len);
7476d49e1aeSJan Lentfer 				return -1;
7486d49e1aeSJan Lentfer 			}
7496d49e1aeSJan Lentfer 			break;
7506d49e1aeSJan Lentfer 		case EAP_SIM_AT_NEXT_PSEUDONYM:
7516d49e1aeSJan Lentfer 			if (!encr) {
7526d49e1aeSJan Lentfer 				wpa_printf(MSG_ERROR, "EAP-SIM: Unencrypted "
7536d49e1aeSJan Lentfer 					   "AT_NEXT_PSEUDONYM");
7546d49e1aeSJan Lentfer 				return -1;
7556d49e1aeSJan Lentfer 			}
7566d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: (encr) "
7576d49e1aeSJan Lentfer 				   "AT_NEXT_PSEUDONYM");
7586d49e1aeSJan Lentfer 			plen = apos[0] * 256 + apos[1];
7596d49e1aeSJan Lentfer 			if (plen > alen - 2) {
7606d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: (encr) Invalid"
7616d49e1aeSJan Lentfer 					   " AT_NEXT_PSEUDONYM (actual"
7626d49e1aeSJan Lentfer 					   " len %lu, attr len %lu)",
7636d49e1aeSJan Lentfer 					   (unsigned long) plen,
7646d49e1aeSJan Lentfer 					   (unsigned long) alen);
7656d49e1aeSJan Lentfer 				return -1;
7666d49e1aeSJan Lentfer 			}
7676d49e1aeSJan Lentfer 			attr->next_pseudonym = pos + 4;
7686d49e1aeSJan Lentfer 			attr->next_pseudonym_len = plen;
7696d49e1aeSJan Lentfer 			break;
7706d49e1aeSJan Lentfer 		case EAP_SIM_AT_NEXT_REAUTH_ID:
7716d49e1aeSJan Lentfer 			if (!encr) {
7726d49e1aeSJan Lentfer 				wpa_printf(MSG_ERROR, "EAP-SIM: Unencrypted "
7736d49e1aeSJan Lentfer 					   "AT_NEXT_REAUTH_ID");
7746d49e1aeSJan Lentfer 				return -1;
7756d49e1aeSJan Lentfer 			}
7766d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: (encr) "
7776d49e1aeSJan Lentfer 				   "AT_NEXT_REAUTH_ID");
7786d49e1aeSJan Lentfer 			plen = apos[0] * 256 + apos[1];
7796d49e1aeSJan Lentfer 			if (plen > alen - 2) {
7806d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: (encr) Invalid"
7816d49e1aeSJan Lentfer 					   " AT_NEXT_REAUTH_ID (actual"
7826d49e1aeSJan Lentfer 					   " len %lu, attr len %lu)",
7836d49e1aeSJan Lentfer 					   (unsigned long) plen,
7846d49e1aeSJan Lentfer 					   (unsigned long) alen);
7856d49e1aeSJan Lentfer 				return -1;
7866d49e1aeSJan Lentfer 			}
7876d49e1aeSJan Lentfer 			attr->next_reauth_id = pos + 4;
7886d49e1aeSJan Lentfer 			attr->next_reauth_id_len = plen;
7896d49e1aeSJan Lentfer 			break;
7906d49e1aeSJan Lentfer 		case EAP_SIM_AT_RES:
7916d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_RES");
7926d49e1aeSJan Lentfer 			attr->res_len_bits = WPA_GET_BE16(apos);
7936d49e1aeSJan Lentfer 			apos += 2;
7946d49e1aeSJan Lentfer 			alen -= 2;
7956d49e1aeSJan Lentfer 			if (!aka || alen < EAP_AKA_MIN_RES_LEN ||
7966d49e1aeSJan Lentfer 			    alen > EAP_AKA_MAX_RES_LEN) {
7976d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid AT_RES "
7986d49e1aeSJan Lentfer 					   "(len %lu)",
7996d49e1aeSJan Lentfer 					   (unsigned long) alen);
8006d49e1aeSJan Lentfer 				return -1;
8016d49e1aeSJan Lentfer 			}
8026d49e1aeSJan Lentfer 			attr->res = apos;
8036d49e1aeSJan Lentfer 			attr->res_len = alen;
8046d49e1aeSJan Lentfer 			break;
8056d49e1aeSJan Lentfer 		case EAP_SIM_AT_AUTS:
8066d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-AKA: AT_AUTS");
8076d49e1aeSJan Lentfer 			if (!aka) {
8086d49e1aeSJan Lentfer 				wpa_printf(MSG_DEBUG, "EAP-SIM: "
8096d49e1aeSJan Lentfer 					   "Unexpected AT_AUTS");
8106d49e1aeSJan Lentfer 				return -1;
8116d49e1aeSJan Lentfer 			}
8126d49e1aeSJan Lentfer 			if (alen != EAP_AKA_AUTS_LEN) {
8136d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-AKA: Invalid AT_AUTS"
8146d49e1aeSJan Lentfer 					   " (len %lu)",
8156d49e1aeSJan Lentfer 					   (unsigned long) alen);
8166d49e1aeSJan Lentfer 				return -1;
8176d49e1aeSJan Lentfer 			}
8186d49e1aeSJan Lentfer 			attr->auts = apos;
8196d49e1aeSJan Lentfer 			break;
8206d49e1aeSJan Lentfer 		case EAP_SIM_AT_CHECKCODE:
8216d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-AKA: AT_CHECKCODE");
8226d49e1aeSJan Lentfer 			if (!aka) {
8236d49e1aeSJan Lentfer 				wpa_printf(MSG_DEBUG, "EAP-SIM: "
8246d49e1aeSJan Lentfer 					   "Unexpected AT_CHECKCODE");
8256d49e1aeSJan Lentfer 				return -1;
8266d49e1aeSJan Lentfer 			}
8276d49e1aeSJan Lentfer 			apos += 2;
8286d49e1aeSJan Lentfer 			alen -= 2;
8296d49e1aeSJan Lentfer 			if (alen != 0 && alen != EAP_AKA_CHECKCODE_LEN &&
8306d49e1aeSJan Lentfer 			    alen != EAP_AKA_PRIME_CHECKCODE_LEN) {
8316d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-AKA: Invalid "
8326d49e1aeSJan Lentfer 					   "AT_CHECKCODE (len %lu)",
8336d49e1aeSJan Lentfer 					   (unsigned long) alen);
8346d49e1aeSJan Lentfer 				return -1;
8356d49e1aeSJan Lentfer 			}
8366d49e1aeSJan Lentfer 			attr->checkcode = apos;
8376d49e1aeSJan Lentfer 			attr->checkcode_len = alen;
8386d49e1aeSJan Lentfer 			break;
8396d49e1aeSJan Lentfer 		case EAP_SIM_AT_RESULT_IND:
8406d49e1aeSJan Lentfer 			if (encr) {
8416d49e1aeSJan Lentfer 				wpa_printf(MSG_ERROR, "EAP-SIM: Encrypted "
8426d49e1aeSJan Lentfer 					   "AT_RESULT_IND");
8436d49e1aeSJan Lentfer 				return -1;
8446d49e1aeSJan Lentfer 			}
8456d49e1aeSJan Lentfer 			if (alen != 2) {
8466d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Invalid "
8476d49e1aeSJan Lentfer 					   "AT_RESULT_IND (alen=%lu)",
8486d49e1aeSJan Lentfer 					   (unsigned long) alen);
8496d49e1aeSJan Lentfer 				return -1;
8506d49e1aeSJan Lentfer 			}
8516d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: AT_RESULT_IND");
8526d49e1aeSJan Lentfer 			attr->result_ind = 1;
8536d49e1aeSJan Lentfer 			break;
8543ff40c12SJohn Marino #if defined(EAP_AKA_PRIME) || defined(EAP_SERVER_AKA_PRIME)
8556d49e1aeSJan Lentfer 		case EAP_SIM_AT_KDF_INPUT:
8566d49e1aeSJan Lentfer 			if (aka != 2) {
8576d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-AKA: Unexpected "
8586d49e1aeSJan Lentfer 					   "AT_KDF_INPUT");
8596d49e1aeSJan Lentfer 				return -1;
8606d49e1aeSJan Lentfer 			}
8616d49e1aeSJan Lentfer 
8626d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-AKA: AT_KDF_INPUT");
8636d49e1aeSJan Lentfer 			plen = WPA_GET_BE16(apos);
8646d49e1aeSJan Lentfer 			apos += 2;
8656d49e1aeSJan Lentfer 			alen -= 2;
8666d49e1aeSJan Lentfer 			if (plen > alen) {
8676d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-AKA': Invalid "
8686d49e1aeSJan Lentfer 					   "AT_KDF_INPUT (Actual Length %lu, "
8696d49e1aeSJan Lentfer 					   "remaining length %lu)",
8706d49e1aeSJan Lentfer 					   (unsigned long) plen,
8716d49e1aeSJan Lentfer 					   (unsigned long) alen);
8726d49e1aeSJan Lentfer 				return -1;
8736d49e1aeSJan Lentfer 			}
8746d49e1aeSJan Lentfer 			attr->kdf_input = apos;
8756d49e1aeSJan Lentfer 			attr->kdf_input_len = plen;
8766d49e1aeSJan Lentfer 			break;
8776d49e1aeSJan Lentfer 		case EAP_SIM_AT_KDF:
8786d49e1aeSJan Lentfer 			if (aka != 2) {
8796d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-AKA: Unexpected "
8806d49e1aeSJan Lentfer 					   "AT_KDF");
8816d49e1aeSJan Lentfer 				return -1;
8826d49e1aeSJan Lentfer 			}
8836d49e1aeSJan Lentfer 
8846d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-AKA: AT_KDF");
8856d49e1aeSJan Lentfer 			if (alen != 2) {
8866d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-AKA': Invalid "
8876d49e1aeSJan Lentfer 					   "AT_KDF (len %lu)",
8886d49e1aeSJan Lentfer 					   (unsigned long) alen);
8896d49e1aeSJan Lentfer 				return -1;
8906d49e1aeSJan Lentfer 			}
8916d49e1aeSJan Lentfer 			if (attr->kdf_count == EAP_AKA_PRIME_KDF_MAX) {
8926d49e1aeSJan Lentfer 				wpa_printf(MSG_DEBUG, "EAP-AKA': Too many "
8936d49e1aeSJan Lentfer 					   "AT_KDF attributes - ignore this");
894*a1157835SDaniel Fojt 				break;
8956d49e1aeSJan Lentfer 			}
8966d49e1aeSJan Lentfer 			attr->kdf[attr->kdf_count] = WPA_GET_BE16(apos);
8976d49e1aeSJan Lentfer 			attr->kdf_count++;
8986d49e1aeSJan Lentfer 			break;
8996d49e1aeSJan Lentfer 		case EAP_SIM_AT_BIDDING:
9006d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-AKA: AT_BIDDING");
9016d49e1aeSJan Lentfer 			if (alen != 2) {
9026d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-AKA: Invalid "
9036d49e1aeSJan Lentfer 					   "AT_BIDDING (len %lu)",
9046d49e1aeSJan Lentfer 					   (unsigned long) alen);
9056d49e1aeSJan Lentfer 				return -1;
9066d49e1aeSJan Lentfer 			}
9076d49e1aeSJan Lentfer 			attr->bidding = apos;
9086d49e1aeSJan Lentfer 			break;
9093ff40c12SJohn Marino #endif /* EAP_AKA_PRIME || EAP_SERVER_AKA_PRIME */
9106d49e1aeSJan Lentfer 		default:
9116d49e1aeSJan Lentfer 			if (pos[0] < 128) {
9126d49e1aeSJan Lentfer 				wpa_printf(MSG_INFO, "EAP-SIM: Unrecognized "
9136d49e1aeSJan Lentfer 					   "non-skippable attribute %d",
9146d49e1aeSJan Lentfer 					   pos[0]);
9156d49e1aeSJan Lentfer 				return -1;
9166d49e1aeSJan Lentfer 			}
9176d49e1aeSJan Lentfer 
9186d49e1aeSJan Lentfer 			wpa_printf(MSG_DEBUG, "EAP-SIM: Unrecognized skippable"
9196d49e1aeSJan Lentfer 				   " attribute %d ignored", pos[0]);
9206d49e1aeSJan Lentfer 			break;
9216d49e1aeSJan Lentfer 		}
9226d49e1aeSJan Lentfer 
9236d49e1aeSJan Lentfer 		pos += pos[1] * 4;
9246d49e1aeSJan Lentfer 	}
9256d49e1aeSJan Lentfer 
9266d49e1aeSJan Lentfer 	wpa_printf(MSG_DEBUG, "EAP-SIM: Attributes parsed successfully "
9276d49e1aeSJan Lentfer 		   "(aka=%d encr=%d)", aka, encr);
9286d49e1aeSJan Lentfer 
9296d49e1aeSJan Lentfer 	return 0;
9306d49e1aeSJan Lentfer }
9316d49e1aeSJan Lentfer 
9326d49e1aeSJan Lentfer 
eap_sim_parse_encr(const u8 * k_encr,const u8 * encr_data,size_t encr_data_len,const u8 * iv,struct eap_sim_attrs * attr,int aka)9336d49e1aeSJan Lentfer u8 * eap_sim_parse_encr(const u8 *k_encr, const u8 *encr_data,
9346d49e1aeSJan Lentfer 			size_t encr_data_len, const u8 *iv,
9356d49e1aeSJan Lentfer 			struct eap_sim_attrs *attr, int aka)
9366d49e1aeSJan Lentfer {
9376d49e1aeSJan Lentfer 	u8 *decrypted;
9386d49e1aeSJan Lentfer 
9396d49e1aeSJan Lentfer 	if (!iv) {
9406d49e1aeSJan Lentfer 		wpa_printf(MSG_INFO, "EAP-SIM: Encrypted data, but no IV");
9416d49e1aeSJan Lentfer 		return NULL;
9426d49e1aeSJan Lentfer 	}
9436d49e1aeSJan Lentfer 
944*a1157835SDaniel Fojt 	decrypted = os_memdup(encr_data, encr_data_len);
9456d49e1aeSJan Lentfer 	if (decrypted == NULL)
9466d49e1aeSJan Lentfer 		return NULL;
9476d49e1aeSJan Lentfer 
948*a1157835SDaniel Fojt #ifdef TEST_FUZZ
949*a1157835SDaniel Fojt 		wpa_printf(MSG_INFO,
950*a1157835SDaniel Fojt 			   "TEST: Skip AES-128-CBC decryption for fuzz testing");
951*a1157835SDaniel Fojt #else /* TEST_FUZZ */
9526d49e1aeSJan Lentfer 	if (aes_128_cbc_decrypt(k_encr, iv, decrypted, encr_data_len)) {
9536d49e1aeSJan Lentfer 		os_free(decrypted);
9546d49e1aeSJan Lentfer 		return NULL;
9556d49e1aeSJan Lentfer 	}
956*a1157835SDaniel Fojt #endif /* TEST_FUZZ */
9576d49e1aeSJan Lentfer 	wpa_hexdump(MSG_MSGDUMP, "EAP-SIM: Decrypted AT_ENCR_DATA",
9586d49e1aeSJan Lentfer 		    decrypted, encr_data_len);
9596d49e1aeSJan Lentfer 
9606d49e1aeSJan Lentfer 	if (eap_sim_parse_attr(decrypted, decrypted + encr_data_len, attr,
9616d49e1aeSJan Lentfer 			       aka, 1)) {
9626d49e1aeSJan Lentfer 		wpa_printf(MSG_INFO, "EAP-SIM: (encr) Failed to parse "
9636d49e1aeSJan Lentfer 			   "decrypted AT_ENCR_DATA");
9646d49e1aeSJan Lentfer 		os_free(decrypted);
9656d49e1aeSJan Lentfer 		return NULL;
9666d49e1aeSJan Lentfer 	}
9676d49e1aeSJan Lentfer 
9686d49e1aeSJan Lentfer 	return decrypted;
9696d49e1aeSJan Lentfer }
9706d49e1aeSJan Lentfer 
9716d49e1aeSJan Lentfer 
9726d49e1aeSJan Lentfer #define EAP_SIM_INIT_LEN 128
9736d49e1aeSJan Lentfer 
9746d49e1aeSJan Lentfer struct eap_sim_msg {
9756d49e1aeSJan Lentfer 	struct wpabuf *buf;
9766d49e1aeSJan Lentfer 	size_t mac, iv, encr; /* index from buf */
9776d49e1aeSJan Lentfer };
9786d49e1aeSJan Lentfer 
9796d49e1aeSJan Lentfer 
eap_sim_msg_init(int code,int id,int type,int subtype)9806d49e1aeSJan Lentfer struct eap_sim_msg * eap_sim_msg_init(int code, int id, int type, int subtype)
9816d49e1aeSJan Lentfer {
9826d49e1aeSJan Lentfer 	struct eap_sim_msg *msg;
9836d49e1aeSJan Lentfer 	struct eap_hdr *eap;
9846d49e1aeSJan Lentfer 	u8 *pos;
9856d49e1aeSJan Lentfer 
9866d49e1aeSJan Lentfer 	msg = os_zalloc(sizeof(*msg));
9876d49e1aeSJan Lentfer 	if (msg == NULL)
9886d49e1aeSJan Lentfer 		return NULL;
9896d49e1aeSJan Lentfer 
9906d49e1aeSJan Lentfer 	msg->buf = wpabuf_alloc(EAP_SIM_INIT_LEN);
9916d49e1aeSJan Lentfer 	if (msg->buf == NULL) {
9926d49e1aeSJan Lentfer 		os_free(msg);
9936d49e1aeSJan Lentfer 		return NULL;
9946d49e1aeSJan Lentfer 	}
9956d49e1aeSJan Lentfer 	eap = wpabuf_put(msg->buf, sizeof(*eap));
9966d49e1aeSJan Lentfer 	eap->code = code;
9976d49e1aeSJan Lentfer 	eap->identifier = id;
9986d49e1aeSJan Lentfer 
9996d49e1aeSJan Lentfer 	pos = wpabuf_put(msg->buf, 4);
10006d49e1aeSJan Lentfer 	*pos++ = type;
10016d49e1aeSJan Lentfer 	*pos++ = subtype;
10026d49e1aeSJan Lentfer 	*pos++ = 0; /* Reserved */
10036d49e1aeSJan Lentfer 	*pos++ = 0; /* Reserved */
10046d49e1aeSJan Lentfer 
10056d49e1aeSJan Lentfer 	return msg;
10066d49e1aeSJan Lentfer }
10076d49e1aeSJan Lentfer 
10086d49e1aeSJan Lentfer 
eap_sim_msg_finish(struct eap_sim_msg * msg,int type,const u8 * k_aut,const u8 * extra,size_t extra_len)1009*a1157835SDaniel Fojt struct wpabuf * eap_sim_msg_finish(struct eap_sim_msg *msg, int type,
1010*a1157835SDaniel Fojt 				   const u8 *k_aut,
10116d49e1aeSJan Lentfer 				   const u8 *extra, size_t extra_len)
10126d49e1aeSJan Lentfer {
10136d49e1aeSJan Lentfer 	struct eap_hdr *eap;
10146d49e1aeSJan Lentfer 	struct wpabuf *buf;
10156d49e1aeSJan Lentfer 
10166d49e1aeSJan Lentfer 	if (msg == NULL)
10176d49e1aeSJan Lentfer 		return NULL;
10186d49e1aeSJan Lentfer 
10196d49e1aeSJan Lentfer 	eap = wpabuf_mhead(msg->buf);
10206d49e1aeSJan Lentfer 	eap->length = host_to_be16(wpabuf_len(msg->buf));
10216d49e1aeSJan Lentfer 
10223ff40c12SJohn Marino #if defined(EAP_AKA_PRIME) || defined(EAP_SERVER_AKA_PRIME)
1023*a1157835SDaniel Fojt 	if (k_aut && msg->mac && type == EAP_TYPE_AKA_PRIME) {
10246d49e1aeSJan Lentfer 		eap_sim_add_mac_sha256(k_aut, (u8 *) wpabuf_head(msg->buf),
10256d49e1aeSJan Lentfer 				       wpabuf_len(msg->buf),
10266d49e1aeSJan Lentfer 				       (u8 *) wpabuf_mhead(msg->buf) +
10276d49e1aeSJan Lentfer 				       msg->mac, extra, extra_len);
10286d49e1aeSJan Lentfer 	} else
10293ff40c12SJohn Marino #endif /* EAP_AKA_PRIME || EAP_SERVER_AKA_PRIME */
10306d49e1aeSJan Lentfer 	if (k_aut && msg->mac) {
10316d49e1aeSJan Lentfer 		eap_sim_add_mac(k_aut, (u8 *) wpabuf_head(msg->buf),
10326d49e1aeSJan Lentfer 				wpabuf_len(msg->buf),
10336d49e1aeSJan Lentfer 				(u8 *) wpabuf_mhead(msg->buf) + msg->mac,
10346d49e1aeSJan Lentfer 				extra, extra_len);
10356d49e1aeSJan Lentfer 	}
10366d49e1aeSJan Lentfer 
10376d49e1aeSJan Lentfer 	buf = msg->buf;
10386d49e1aeSJan Lentfer 	os_free(msg);
10396d49e1aeSJan Lentfer 	return buf;
10406d49e1aeSJan Lentfer }
10416d49e1aeSJan Lentfer 
10426d49e1aeSJan Lentfer 
eap_sim_msg_free(struct eap_sim_msg * msg)10436d49e1aeSJan Lentfer void eap_sim_msg_free(struct eap_sim_msg *msg)
10446d49e1aeSJan Lentfer {
10456d49e1aeSJan Lentfer 	if (msg) {
10466d49e1aeSJan Lentfer 		wpabuf_free(msg->buf);
10476d49e1aeSJan Lentfer 		os_free(msg);
10486d49e1aeSJan Lentfer 	}
10496d49e1aeSJan Lentfer }
10506d49e1aeSJan Lentfer 
10516d49e1aeSJan Lentfer 
eap_sim_msg_add_full(struct eap_sim_msg * msg,u8 attr,const u8 * data,size_t len)10526d49e1aeSJan Lentfer u8 * eap_sim_msg_add_full(struct eap_sim_msg *msg, u8 attr,
10536d49e1aeSJan Lentfer 			  const u8 *data, size_t len)
10546d49e1aeSJan Lentfer {
10556d49e1aeSJan Lentfer 	int attr_len = 2 + len;
10566d49e1aeSJan Lentfer 	int pad_len;
10576d49e1aeSJan Lentfer 	u8 *start;
10586d49e1aeSJan Lentfer 
10596d49e1aeSJan Lentfer 	if (msg == NULL)
10606d49e1aeSJan Lentfer 		return NULL;
10616d49e1aeSJan Lentfer 
10626d49e1aeSJan Lentfer 	pad_len = (4 - attr_len % 4) % 4;
10636d49e1aeSJan Lentfer 	attr_len += pad_len;
10646d49e1aeSJan Lentfer 	if (wpabuf_resize(&msg->buf, attr_len))
10656d49e1aeSJan Lentfer 		return NULL;
10666d49e1aeSJan Lentfer 	start = wpabuf_put(msg->buf, 0);
10676d49e1aeSJan Lentfer 	wpabuf_put_u8(msg->buf, attr);
10686d49e1aeSJan Lentfer 	wpabuf_put_u8(msg->buf, attr_len / 4);
10696d49e1aeSJan Lentfer 	wpabuf_put_data(msg->buf, data, len);
10706d49e1aeSJan Lentfer 	if (pad_len)
10716d49e1aeSJan Lentfer 		os_memset(wpabuf_put(msg->buf, pad_len), 0, pad_len);
10726d49e1aeSJan Lentfer 	return start;
10736d49e1aeSJan Lentfer }
10746d49e1aeSJan Lentfer 
10756d49e1aeSJan Lentfer 
eap_sim_msg_add(struct eap_sim_msg * msg,u8 attr,u16 value,const u8 * data,size_t len)10766d49e1aeSJan Lentfer u8 * eap_sim_msg_add(struct eap_sim_msg *msg, u8 attr, u16 value,
10776d49e1aeSJan Lentfer 		     const u8 *data, size_t len)
10786d49e1aeSJan Lentfer {
10796d49e1aeSJan Lentfer 	int attr_len = 4 + len;
10806d49e1aeSJan Lentfer 	int pad_len;
10816d49e1aeSJan Lentfer 	u8 *start;
10826d49e1aeSJan Lentfer 
10836d49e1aeSJan Lentfer 	if (msg == NULL)
10846d49e1aeSJan Lentfer 		return NULL;
10856d49e1aeSJan Lentfer 
10866d49e1aeSJan Lentfer 	pad_len = (4 - attr_len % 4) % 4;
10876d49e1aeSJan Lentfer 	attr_len += pad_len;
10886d49e1aeSJan Lentfer 	if (wpabuf_resize(&msg->buf, attr_len))
10896d49e1aeSJan Lentfer 		return NULL;
10906d49e1aeSJan Lentfer 	start = wpabuf_put(msg->buf, 0);
10916d49e1aeSJan Lentfer 	wpabuf_put_u8(msg->buf, attr);
10926d49e1aeSJan Lentfer 	wpabuf_put_u8(msg->buf, attr_len / 4);
10936d49e1aeSJan Lentfer 	wpabuf_put_be16(msg->buf, value);
10946d49e1aeSJan Lentfer 	if (data)
10956d49e1aeSJan Lentfer 		wpabuf_put_data(msg->buf, data, len);
10966d49e1aeSJan Lentfer 	else
10976d49e1aeSJan Lentfer 		wpabuf_put(msg->buf, len);
10986d49e1aeSJan Lentfer 	if (pad_len)
10996d49e1aeSJan Lentfer 		os_memset(wpabuf_put(msg->buf, pad_len), 0, pad_len);
11006d49e1aeSJan Lentfer 	return start;
11016d49e1aeSJan Lentfer }
11026d49e1aeSJan Lentfer 
11036d49e1aeSJan Lentfer 
eap_sim_msg_add_mac(struct eap_sim_msg * msg,u8 attr)11046d49e1aeSJan Lentfer u8 * eap_sim_msg_add_mac(struct eap_sim_msg *msg, u8 attr)
11056d49e1aeSJan Lentfer {
11066d49e1aeSJan Lentfer 	u8 *pos = eap_sim_msg_add(msg, attr, 0, NULL, EAP_SIM_MAC_LEN);
11076d49e1aeSJan Lentfer 	if (pos)
11086d49e1aeSJan Lentfer 		msg->mac = (pos - wpabuf_head_u8(msg->buf)) + 4;
11096d49e1aeSJan Lentfer 	return pos;
11106d49e1aeSJan Lentfer }
11116d49e1aeSJan Lentfer 
11126d49e1aeSJan Lentfer 
eap_sim_msg_add_encr_start(struct eap_sim_msg * msg,u8 attr_iv,u8 attr_encr)11136d49e1aeSJan Lentfer int eap_sim_msg_add_encr_start(struct eap_sim_msg *msg, u8 attr_iv,
11146d49e1aeSJan Lentfer 			       u8 attr_encr)
11156d49e1aeSJan Lentfer {
11166d49e1aeSJan Lentfer 	u8 *pos = eap_sim_msg_add(msg, attr_iv, 0, NULL, EAP_SIM_IV_LEN);
11176d49e1aeSJan Lentfer 	if (pos == NULL)
11186d49e1aeSJan Lentfer 		return -1;
11196d49e1aeSJan Lentfer 	msg->iv = (pos - wpabuf_head_u8(msg->buf)) + 4;
11203ff40c12SJohn Marino 	if (random_get_bytes(wpabuf_mhead_u8(msg->buf) + msg->iv,
11216d49e1aeSJan Lentfer 			     EAP_SIM_IV_LEN)) {
11226d49e1aeSJan Lentfer 		msg->iv = 0;
11236d49e1aeSJan Lentfer 		return -1;
11246d49e1aeSJan Lentfer 	}
11256d49e1aeSJan Lentfer 
11266d49e1aeSJan Lentfer 	pos = eap_sim_msg_add(msg, attr_encr, 0, NULL, 0);
11276d49e1aeSJan Lentfer 	if (pos == NULL) {
11286d49e1aeSJan Lentfer 		msg->iv = 0;
11296d49e1aeSJan Lentfer 		return -1;
11306d49e1aeSJan Lentfer 	}
11316d49e1aeSJan Lentfer 	msg->encr = pos - wpabuf_head_u8(msg->buf);
11326d49e1aeSJan Lentfer 
11336d49e1aeSJan Lentfer 	return 0;
11346d49e1aeSJan Lentfer }
11356d49e1aeSJan Lentfer 
11366d49e1aeSJan Lentfer 
eap_sim_msg_add_encr_end(struct eap_sim_msg * msg,u8 * k_encr,int attr_pad)11376d49e1aeSJan Lentfer int eap_sim_msg_add_encr_end(struct eap_sim_msg *msg, u8 *k_encr, int attr_pad)
11386d49e1aeSJan Lentfer {
11396d49e1aeSJan Lentfer 	size_t encr_len;
11406d49e1aeSJan Lentfer 
11416d49e1aeSJan Lentfer 	if (msg == NULL || k_encr == NULL || msg->iv == 0 || msg->encr == 0)
11426d49e1aeSJan Lentfer 		return -1;
11436d49e1aeSJan Lentfer 
11446d49e1aeSJan Lentfer 	encr_len = wpabuf_len(msg->buf) - msg->encr - 4;
11456d49e1aeSJan Lentfer 	if (encr_len % 16) {
11466d49e1aeSJan Lentfer 		u8 *pos;
11476d49e1aeSJan Lentfer 		int pad_len = 16 - (encr_len % 16);
11486d49e1aeSJan Lentfer 		if (pad_len < 4) {
11496d49e1aeSJan Lentfer 			wpa_printf(MSG_WARNING, "EAP-SIM: "
11506d49e1aeSJan Lentfer 				   "eap_sim_msg_add_encr_end - invalid pad_len"
11516d49e1aeSJan Lentfer 				   " %d", pad_len);
11526d49e1aeSJan Lentfer 			return -1;
11536d49e1aeSJan Lentfer 		}
11546d49e1aeSJan Lentfer 		wpa_printf(MSG_DEBUG, "   *AT_PADDING");
11556d49e1aeSJan Lentfer 		pos = eap_sim_msg_add(msg, attr_pad, 0, NULL, pad_len - 4);
11566d49e1aeSJan Lentfer 		if (pos == NULL)
11576d49e1aeSJan Lentfer 			return -1;
11586d49e1aeSJan Lentfer 		os_memset(pos + 4, 0, pad_len - 4);
11596d49e1aeSJan Lentfer 		encr_len += pad_len;
11606d49e1aeSJan Lentfer 	}
11616d49e1aeSJan Lentfer 	wpa_printf(MSG_DEBUG, "   (AT_ENCR_DATA data len %lu)",
11626d49e1aeSJan Lentfer 		   (unsigned long) encr_len);
11636d49e1aeSJan Lentfer 	wpabuf_mhead_u8(msg->buf)[msg->encr + 1] = encr_len / 4 + 1;
11646d49e1aeSJan Lentfer 	return aes_128_cbc_encrypt(k_encr, wpabuf_head_u8(msg->buf) + msg->iv,
11656d49e1aeSJan Lentfer 				   wpabuf_mhead_u8(msg->buf) + msg->encr + 4,
11666d49e1aeSJan Lentfer 				   encr_len);
11676d49e1aeSJan Lentfer }
11686d49e1aeSJan Lentfer 
11696d49e1aeSJan Lentfer 
eap_sim_report_notification(void * msg_ctx,int notification,int aka)11706d49e1aeSJan Lentfer void eap_sim_report_notification(void *msg_ctx, int notification, int aka)
11716d49e1aeSJan Lentfer {
11726d49e1aeSJan Lentfer #ifndef CONFIG_NO_STDOUT_DEBUG
11736d49e1aeSJan Lentfer 	const char *type = aka ? "AKA" : "SIM";
11746d49e1aeSJan Lentfer #endif /* CONFIG_NO_STDOUT_DEBUG */
11756d49e1aeSJan Lentfer 
11766d49e1aeSJan Lentfer 	switch (notification) {
11776d49e1aeSJan Lentfer 	case EAP_SIM_GENERAL_FAILURE_AFTER_AUTH:
11786d49e1aeSJan Lentfer 		wpa_printf(MSG_WARNING, "EAP-%s: General failure "
11796d49e1aeSJan Lentfer 			   "notification (after authentication)", type);
11806d49e1aeSJan Lentfer 		break;
11816d49e1aeSJan Lentfer 	case EAP_SIM_TEMPORARILY_DENIED:
11826d49e1aeSJan Lentfer 		wpa_printf(MSG_WARNING, "EAP-%s: Failure notification: "
11836d49e1aeSJan Lentfer 			   "User has been temporarily denied access to the "
11846d49e1aeSJan Lentfer 			   "requested service", type);
11856d49e1aeSJan Lentfer 		break;
11866d49e1aeSJan Lentfer 	case EAP_SIM_NOT_SUBSCRIBED:
11876d49e1aeSJan Lentfer 		wpa_printf(MSG_WARNING, "EAP-%s: Failure notification: "
11886d49e1aeSJan Lentfer 			   "User has not subscribed to the requested service",
11896d49e1aeSJan Lentfer 			   type);
11906d49e1aeSJan Lentfer 		break;
11916d49e1aeSJan Lentfer 	case EAP_SIM_GENERAL_FAILURE_BEFORE_AUTH:
11926d49e1aeSJan Lentfer 		wpa_printf(MSG_WARNING, "EAP-%s: General failure "
11936d49e1aeSJan Lentfer 			   "notification (before authentication)", type);
11946d49e1aeSJan Lentfer 		break;
11956d49e1aeSJan Lentfer 	case EAP_SIM_SUCCESS:
11966d49e1aeSJan Lentfer 		wpa_printf(MSG_INFO, "EAP-%s: Successful authentication "
11976d49e1aeSJan Lentfer 			   "notification", type);
11986d49e1aeSJan Lentfer 		break;
11996d49e1aeSJan Lentfer 	default:
12006d49e1aeSJan Lentfer 		if (notification >= 32768) {
12016d49e1aeSJan Lentfer 			wpa_printf(MSG_INFO, "EAP-%s: Unrecognized "
12026d49e1aeSJan Lentfer 				   "non-failure notification %d",
12036d49e1aeSJan Lentfer 				   type, notification);
12046d49e1aeSJan Lentfer 		} else {
12056d49e1aeSJan Lentfer 			wpa_printf(MSG_WARNING, "EAP-%s: Unrecognized "
12066d49e1aeSJan Lentfer 				   "failure notification %d",
12076d49e1aeSJan Lentfer 				   type, notification);
12086d49e1aeSJan Lentfer 		}
12096d49e1aeSJan Lentfer 	}
12106d49e1aeSJan Lentfer }
1211*a1157835SDaniel Fojt 
1212*a1157835SDaniel Fojt 
eap_sim_anonymous_username(const u8 * id,size_t id_len)1213*a1157835SDaniel Fojt int eap_sim_anonymous_username(const u8 *id, size_t id_len)
1214*a1157835SDaniel Fojt {
1215*a1157835SDaniel Fojt 	static const char *anonymous_id_prefix = "anonymous@";
1216*a1157835SDaniel Fojt 	size_t anonymous_id_len = os_strlen(anonymous_id_prefix);
1217*a1157835SDaniel Fojt 
1218*a1157835SDaniel Fojt 	if (id_len > anonymous_id_len &&
1219*a1157835SDaniel Fojt 	    os_memcmp(id, anonymous_id_prefix, anonymous_id_len) == 0)
1220*a1157835SDaniel Fojt 		return 1; /* 'anonymous@realm' */
1221*a1157835SDaniel Fojt 
1222*a1157835SDaniel Fojt 	if (id_len > 1 && id[0] == '@')
1223*a1157835SDaniel Fojt 		return 1; /* '@realm' */
1224*a1157835SDaniel Fojt 
1225*a1157835SDaniel Fojt 	return 0;
1226*a1157835SDaniel Fojt }
1227