1189251Ssam/* 2189251Ssam * EAP peer method: EAP-SIM (RFC 4186) 3252726Srpaulo * Copyright (c) 2004-2012, Jouni Malinen <j@w1.fi> 4189251Ssam * 5252726Srpaulo * This software may be distributed under the terms of the BSD license. 6252726Srpaulo * See README for more details. 7189251Ssam */ 8189251Ssam 9189251Ssam#include "includes.h" 10189251Ssam 11189251Ssam#include "common.h" 12214734Srpaulo#include "pcsc_funcs.h" 13214734Srpaulo#include "crypto/milenage.h" 14252726Srpaulo#include "crypto/random.h" 15189251Ssam#include "eap_peer/eap_i.h" 16189251Ssam#include "eap_config.h" 17189251Ssam#include "eap_common/eap_sim_common.h" 18189251Ssam 19189251Ssam 20189251Ssamstruct eap_sim_data { 21189251Ssam u8 *ver_list; 22189251Ssam size_t ver_list_len; 23189251Ssam int selected_version; 24189251Ssam size_t min_num_chal, num_chal; 25189251Ssam 26189251Ssam u8 kc[3][EAP_SIM_KC_LEN]; 27189251Ssam u8 sres[3][EAP_SIM_SRES_LEN]; 28189251Ssam u8 nonce_mt[EAP_SIM_NONCE_MT_LEN], nonce_s[EAP_SIM_NONCE_S_LEN]; 29189251Ssam u8 mk[EAP_SIM_MK_LEN]; 30189251Ssam u8 k_aut[EAP_SIM_K_AUT_LEN]; 31189251Ssam u8 k_encr[EAP_SIM_K_ENCR_LEN]; 32189251Ssam u8 msk[EAP_SIM_KEYING_DATA_LEN]; 33189251Ssam u8 emsk[EAP_EMSK_LEN]; 34189251Ssam u8 rand[3][GSM_RAND_LEN]; 35189251Ssam 36189251Ssam int num_id_req, num_notification; 37189251Ssam u8 *pseudonym; 38189251Ssam size_t pseudonym_len; 39189251Ssam u8 *reauth_id; 40189251Ssam size_t reauth_id_len; 41189251Ssam int reauth; 42189251Ssam unsigned int counter, counter_too_small; 43189251Ssam u8 *last_eap_identity; 44189251Ssam size_t last_eap_identity_len; 45189251Ssam enum { 46189251Ssam CONTINUE, RESULT_SUCCESS, RESULT_FAILURE, SUCCESS, FAILURE 47189251Ssam } state; 48189251Ssam int result_ind, use_result_ind; 49189251Ssam}; 50189251Ssam 51189251Ssam 52189251Ssam#ifndef CONFIG_NO_STDOUT_DEBUG 53189251Ssamstatic const char * eap_sim_state_txt(int state) 54189251Ssam{ 55189251Ssam switch (state) { 56189251Ssam case CONTINUE: 57189251Ssam return "CONTINUE"; 58189251Ssam case RESULT_SUCCESS: 59189251Ssam return "RESULT_SUCCESS"; 60189251Ssam case RESULT_FAILURE: 61189251Ssam return "RESULT_FAILURE"; 62189251Ssam case SUCCESS: 63189251Ssam return "SUCCESS"; 64189251Ssam case FAILURE: 65189251Ssam return "FAILURE"; 66189251Ssam default: 67189251Ssam return "?"; 68189251Ssam } 69189251Ssam} 70189251Ssam#endif /* CONFIG_NO_STDOUT_DEBUG */ 71189251Ssam 72189251Ssam 73189251Ssamstatic void eap_sim_state(struct eap_sim_data *data, int state) 74189251Ssam{ 75189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: %s -> %s", 76189251Ssam eap_sim_state_txt(data->state), 77189251Ssam eap_sim_state_txt(state)); 78189251Ssam data->state = state; 79189251Ssam} 80189251Ssam 81189251Ssam 82189251Ssamstatic void * eap_sim_init(struct eap_sm *sm) 83189251Ssam{ 84189251Ssam struct eap_sim_data *data; 85189251Ssam struct eap_peer_config *config = eap_get_config(sm); 86189251Ssam 87189251Ssam data = os_zalloc(sizeof(*data)); 88189251Ssam if (data == NULL) 89189251Ssam return NULL; 90189251Ssam 91252726Srpaulo if (random_get_bytes(data->nonce_mt, EAP_SIM_NONCE_MT_LEN)) { 92189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Failed to get random data " 93189251Ssam "for NONCE_MT"); 94189251Ssam os_free(data); 95189251Ssam return NULL; 96189251Ssam } 97189251Ssam 98189251Ssam data->min_num_chal = 2; 99189251Ssam if (config && config->phase1) { 100189251Ssam char *pos = os_strstr(config->phase1, "sim_min_num_chal="); 101189251Ssam if (pos) { 102189251Ssam data->min_num_chal = atoi(pos + 17); 103189251Ssam if (data->min_num_chal < 2 || data->min_num_chal > 3) { 104189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Invalid " 105189251Ssam "sim_min_num_chal configuration " 106189251Ssam "(%lu, expected 2 or 3)", 107189251Ssam (unsigned long) data->min_num_chal); 108189251Ssam os_free(data); 109189251Ssam return NULL; 110189251Ssam } 111189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: Set minimum number of " 112189251Ssam "challenges to %lu", 113189251Ssam (unsigned long) data->min_num_chal); 114189251Ssam } 115189251Ssam 116189251Ssam data->result_ind = os_strstr(config->phase1, "result_ind=1") != 117189251Ssam NULL; 118189251Ssam } 119189251Ssam 120252726Srpaulo if (config && config->anonymous_identity) { 121252726Srpaulo data->pseudonym = os_malloc(config->anonymous_identity_len); 122252726Srpaulo if (data->pseudonym) { 123252726Srpaulo os_memcpy(data->pseudonym, config->anonymous_identity, 124252726Srpaulo config->anonymous_identity_len); 125252726Srpaulo data->pseudonym_len = config->anonymous_identity_len; 126252726Srpaulo } 127252726Srpaulo } 128252726Srpaulo 129189251Ssam eap_sim_state(data, CONTINUE); 130189251Ssam 131189251Ssam return data; 132189251Ssam} 133189251Ssam 134189251Ssam 135189251Ssamstatic void eap_sim_deinit(struct eap_sm *sm, void *priv) 136189251Ssam{ 137189251Ssam struct eap_sim_data *data = priv; 138189251Ssam if (data) { 139189251Ssam os_free(data->ver_list); 140189251Ssam os_free(data->pseudonym); 141189251Ssam os_free(data->reauth_id); 142189251Ssam os_free(data->last_eap_identity); 143189251Ssam os_free(data); 144189251Ssam } 145189251Ssam} 146189251Ssam 147189251Ssam 148189251Ssamstatic int eap_sim_gsm_auth(struct eap_sm *sm, struct eap_sim_data *data) 149189251Ssam{ 150189251Ssam struct eap_peer_config *conf; 151189251Ssam 152189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: GSM authentication algorithm"); 153189251Ssam 154189251Ssam conf = eap_get_config(sm); 155189251Ssam if (conf == NULL) 156189251Ssam return -1; 157189251Ssam if (conf->pcsc) { 158189251Ssam if (scard_gsm_auth(sm->scard_ctx, data->rand[0], 159189251Ssam data->sres[0], data->kc[0]) || 160189251Ssam scard_gsm_auth(sm->scard_ctx, data->rand[1], 161189251Ssam data->sres[1], data->kc[1]) || 162189251Ssam (data->num_chal > 2 && 163189251Ssam scard_gsm_auth(sm->scard_ctx, data->rand[2], 164189251Ssam data->sres[2], data->kc[2]))) { 165189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: GSM SIM " 166189251Ssam "authentication could not be completed"); 167189251Ssam return -1; 168189251Ssam } 169189251Ssam return 0; 170189251Ssam } 171189251Ssam 172189251Ssam#ifdef CONFIG_SIM_SIMULATOR 173189251Ssam if (conf->password) { 174189251Ssam u8 opc[16], k[16]; 175189251Ssam const char *pos; 176189251Ssam size_t i; 177189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: Use internal GSM-Milenage " 178189251Ssam "implementation for authentication"); 179189251Ssam if (conf->password_len < 65) { 180189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: invalid GSM-Milenage " 181189251Ssam "password"); 182189251Ssam return -1; 183189251Ssam } 184189251Ssam pos = (const char *) conf->password; 185189251Ssam if (hexstr2bin(pos, k, 16)) 186189251Ssam return -1; 187189251Ssam pos += 32; 188189251Ssam if (*pos != ':') 189189251Ssam return -1; 190189251Ssam pos++; 191189251Ssam 192189251Ssam if (hexstr2bin(pos, opc, 16)) 193189251Ssam return -1; 194189251Ssam 195189251Ssam for (i = 0; i < data->num_chal; i++) { 196189251Ssam if (gsm_milenage(opc, k, data->rand[i], 197189251Ssam data->sres[i], data->kc[i])) { 198189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: " 199189251Ssam "GSM-Milenage authentication " 200189251Ssam "could not be completed"); 201189251Ssam return -1; 202189251Ssam } 203189251Ssam wpa_hexdump(MSG_DEBUG, "EAP-SIM: RAND", 204189251Ssam data->rand[i], GSM_RAND_LEN); 205189251Ssam wpa_hexdump_key(MSG_DEBUG, "EAP-SIM: SRES", 206189251Ssam data->sres[i], EAP_SIM_SRES_LEN); 207189251Ssam wpa_hexdump_key(MSG_DEBUG, "EAP-SIM: Kc", 208189251Ssam data->kc[i], EAP_SIM_KC_LEN); 209189251Ssam } 210189251Ssam return 0; 211189251Ssam } 212189251Ssam#endif /* CONFIG_SIM_SIMULATOR */ 213189251Ssam 214189251Ssam#ifdef CONFIG_SIM_HARDCODED 215189251Ssam /* These hardcoded Kc and SRES values are used for testing. RAND to 216189251Ssam * KC/SREC mapping is very bogus as far as real authentication is 217189251Ssam * concerned, but it is quite useful for cases where the AS is rotating 218189251Ssam * the order of pre-configured values. */ 219189251Ssam { 220189251Ssam size_t i; 221189251Ssam 222189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: Use hardcoded Kc and SRES " 223189251Ssam "values for testing"); 224189251Ssam 225189251Ssam for (i = 0; i < data->num_chal; i++) { 226189251Ssam if (data->rand[i][0] == 0xaa) { 227189251Ssam os_memcpy(data->kc[i], 228189251Ssam "\xa0\xa1\xa2\xa3\xa4\xa5\xa6\xa7", 229189251Ssam EAP_SIM_KC_LEN); 230189251Ssam os_memcpy(data->sres[i], "\xd1\xd2\xd3\xd4", 231189251Ssam EAP_SIM_SRES_LEN); 232189251Ssam } else if (data->rand[i][0] == 0xbb) { 233189251Ssam os_memcpy(data->kc[i], 234189251Ssam "\xb0\xb1\xb2\xb3\xb4\xb5\xb6\xb7", 235189251Ssam EAP_SIM_KC_LEN); 236189251Ssam os_memcpy(data->sres[i], "\xe1\xe2\xe3\xe4", 237189251Ssam EAP_SIM_SRES_LEN); 238189251Ssam } else { 239189251Ssam os_memcpy(data->kc[i], 240189251Ssam "\xc0\xc1\xc2\xc3\xc4\xc5\xc6\xc7", 241189251Ssam EAP_SIM_KC_LEN); 242189251Ssam os_memcpy(data->sres[i], "\xf1\xf2\xf3\xf4", 243189251Ssam EAP_SIM_SRES_LEN); 244189251Ssam } 245189251Ssam } 246189251Ssam } 247189251Ssam 248189251Ssam return 0; 249189251Ssam 250189251Ssam#else /* CONFIG_SIM_HARDCODED */ 251189251Ssam 252189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: No GSM authentication algorithm " 253189251Ssam "enabled"); 254189251Ssam return -1; 255189251Ssam 256189251Ssam#endif /* CONFIG_SIM_HARDCODED */ 257189251Ssam} 258189251Ssam 259189251Ssam 260189251Ssamstatic int eap_sim_supported_ver(int version) 261189251Ssam{ 262189251Ssam return version == EAP_SIM_VERSION; 263189251Ssam} 264189251Ssam 265189251Ssam 266189251Ssam#define CLEAR_PSEUDONYM 0x01 267189251Ssam#define CLEAR_REAUTH_ID 0x02 268189251Ssam#define CLEAR_EAP_ID 0x04 269189251Ssam 270252726Srpaulostatic void eap_sim_clear_identities(struct eap_sm *sm, 271252726Srpaulo struct eap_sim_data *data, int id) 272189251Ssam{ 273252726Srpaulo if ((id & CLEAR_PSEUDONYM) && data->pseudonym) { 274252726Srpaulo wpa_printf(MSG_DEBUG, "EAP-SIM: forgetting old pseudonym"); 275189251Ssam os_free(data->pseudonym); 276189251Ssam data->pseudonym = NULL; 277189251Ssam data->pseudonym_len = 0; 278252726Srpaulo eap_set_anon_id(sm, NULL, 0); 279189251Ssam } 280252726Srpaulo if ((id & CLEAR_REAUTH_ID) && data->reauth_id) { 281252726Srpaulo wpa_printf(MSG_DEBUG, "EAP-SIM: forgetting old reauth_id"); 282189251Ssam os_free(data->reauth_id); 283189251Ssam data->reauth_id = NULL; 284189251Ssam data->reauth_id_len = 0; 285189251Ssam } 286252726Srpaulo if ((id & CLEAR_EAP_ID) && data->last_eap_identity) { 287252726Srpaulo wpa_printf(MSG_DEBUG, "EAP-SIM: forgetting old eap_id"); 288189251Ssam os_free(data->last_eap_identity); 289189251Ssam data->last_eap_identity = NULL; 290189251Ssam data->last_eap_identity_len = 0; 291189251Ssam } 292189251Ssam} 293189251Ssam 294189251Ssam 295252726Srpaulostatic int eap_sim_learn_ids(struct eap_sm *sm, struct eap_sim_data *data, 296189251Ssam struct eap_sim_attrs *attr) 297189251Ssam{ 298189251Ssam if (attr->next_pseudonym) { 299252726Srpaulo const u8 *identity = NULL; 300252726Srpaulo size_t identity_len = 0; 301252726Srpaulo const u8 *realm = NULL; 302252726Srpaulo size_t realm_len = 0; 303252726Srpaulo 304252726Srpaulo wpa_hexdump_ascii(MSG_DEBUG, 305252726Srpaulo "EAP-SIM: (encr) AT_NEXT_PSEUDONYM", 306252726Srpaulo attr->next_pseudonym, 307252726Srpaulo attr->next_pseudonym_len); 308189251Ssam os_free(data->pseudonym); 309252726Srpaulo /* Look for the realm of the permanent identity */ 310252726Srpaulo identity = eap_get_config_identity(sm, &identity_len); 311252726Srpaulo if (identity) { 312252726Srpaulo for (realm = identity, realm_len = identity_len; 313252726Srpaulo realm_len > 0; realm_len--, realm++) { 314252726Srpaulo if (*realm == '@') 315252726Srpaulo break; 316252726Srpaulo } 317252726Srpaulo } 318252726Srpaulo data->pseudonym = os_malloc(attr->next_pseudonym_len + 319252726Srpaulo realm_len); 320189251Ssam if (data->pseudonym == NULL) { 321189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: (encr) No memory for " 322189251Ssam "next pseudonym"); 323252726Srpaulo data->pseudonym_len = 0; 324189251Ssam return -1; 325189251Ssam } 326189251Ssam os_memcpy(data->pseudonym, attr->next_pseudonym, 327189251Ssam attr->next_pseudonym_len); 328252726Srpaulo if (realm_len) { 329252726Srpaulo os_memcpy(data->pseudonym + attr->next_pseudonym_len, 330252726Srpaulo realm, realm_len); 331252726Srpaulo } 332252726Srpaulo data->pseudonym_len = attr->next_pseudonym_len + realm_len; 333252726Srpaulo eap_set_anon_id(sm, data->pseudonym, data->pseudonym_len); 334189251Ssam } 335189251Ssam 336189251Ssam if (attr->next_reauth_id) { 337189251Ssam os_free(data->reauth_id); 338189251Ssam data->reauth_id = os_malloc(attr->next_reauth_id_len); 339189251Ssam if (data->reauth_id == NULL) { 340189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: (encr) No memory for " 341189251Ssam "next reauth_id"); 342252726Srpaulo data->reauth_id_len = 0; 343189251Ssam return -1; 344189251Ssam } 345189251Ssam os_memcpy(data->reauth_id, attr->next_reauth_id, 346189251Ssam attr->next_reauth_id_len); 347189251Ssam data->reauth_id_len = attr->next_reauth_id_len; 348189251Ssam wpa_hexdump_ascii(MSG_DEBUG, 349189251Ssam "EAP-SIM: (encr) AT_NEXT_REAUTH_ID", 350189251Ssam data->reauth_id, 351189251Ssam data->reauth_id_len); 352189251Ssam } 353189251Ssam 354189251Ssam return 0; 355189251Ssam} 356189251Ssam 357189251Ssam 358189251Ssamstatic struct wpabuf * eap_sim_client_error(struct eap_sim_data *data, u8 id, 359189251Ssam int err) 360189251Ssam{ 361189251Ssam struct eap_sim_msg *msg; 362189251Ssam 363189251Ssam eap_sim_state(data, FAILURE); 364189251Ssam data->num_id_req = 0; 365189251Ssam data->num_notification = 0; 366189251Ssam 367252726Srpaulo wpa_printf(MSG_DEBUG, "EAP-SIM: Send Client-Error (error code %d)", 368252726Srpaulo err); 369189251Ssam msg = eap_sim_msg_init(EAP_CODE_RESPONSE, id, EAP_TYPE_SIM, 370189251Ssam EAP_SIM_SUBTYPE_CLIENT_ERROR); 371189251Ssam eap_sim_msg_add(msg, EAP_SIM_AT_CLIENT_ERROR_CODE, err, NULL, 0); 372189251Ssam return eap_sim_msg_finish(msg, NULL, NULL, 0); 373189251Ssam} 374189251Ssam 375189251Ssam 376189251Ssamstatic struct wpabuf * eap_sim_response_start(struct eap_sm *sm, 377189251Ssam struct eap_sim_data *data, u8 id, 378189251Ssam enum eap_sim_id_req id_req) 379189251Ssam{ 380189251Ssam const u8 *identity = NULL; 381189251Ssam size_t identity_len = 0; 382189251Ssam struct eap_sim_msg *msg; 383189251Ssam 384189251Ssam data->reauth = 0; 385189251Ssam if (id_req == ANY_ID && data->reauth_id) { 386189251Ssam identity = data->reauth_id; 387189251Ssam identity_len = data->reauth_id_len; 388189251Ssam data->reauth = 1; 389189251Ssam } else if ((id_req == ANY_ID || id_req == FULLAUTH_ID) && 390189251Ssam data->pseudonym) { 391189251Ssam identity = data->pseudonym; 392189251Ssam identity_len = data->pseudonym_len; 393252726Srpaulo eap_sim_clear_identities(sm, data, CLEAR_REAUTH_ID); 394189251Ssam } else if (id_req != NO_ID_REQ) { 395189251Ssam identity = eap_get_config_identity(sm, &identity_len); 396189251Ssam if (identity) { 397252726Srpaulo eap_sim_clear_identities(sm, data, CLEAR_PSEUDONYM | 398189251Ssam CLEAR_REAUTH_ID); 399189251Ssam } 400189251Ssam } 401189251Ssam if (id_req != NO_ID_REQ) 402252726Srpaulo eap_sim_clear_identities(sm, data, CLEAR_EAP_ID); 403189251Ssam 404189251Ssam wpa_printf(MSG_DEBUG, "Generating EAP-SIM Start (id=%d)", id); 405189251Ssam msg = eap_sim_msg_init(EAP_CODE_RESPONSE, id, 406189251Ssam EAP_TYPE_SIM, EAP_SIM_SUBTYPE_START); 407189251Ssam if (!data->reauth) { 408189251Ssam wpa_hexdump(MSG_DEBUG, " AT_NONCE_MT", 409189251Ssam data->nonce_mt, EAP_SIM_NONCE_MT_LEN); 410189251Ssam eap_sim_msg_add(msg, EAP_SIM_AT_NONCE_MT, 0, 411189251Ssam data->nonce_mt, EAP_SIM_NONCE_MT_LEN); 412189251Ssam wpa_printf(MSG_DEBUG, " AT_SELECTED_VERSION %d", 413189251Ssam data->selected_version); 414189251Ssam eap_sim_msg_add(msg, EAP_SIM_AT_SELECTED_VERSION, 415189251Ssam data->selected_version, NULL, 0); 416189251Ssam } 417189251Ssam 418189251Ssam if (identity) { 419189251Ssam wpa_hexdump_ascii(MSG_DEBUG, " AT_IDENTITY", 420189251Ssam identity, identity_len); 421189251Ssam eap_sim_msg_add(msg, EAP_SIM_AT_IDENTITY, identity_len, 422189251Ssam identity, identity_len); 423189251Ssam } 424189251Ssam 425189251Ssam return eap_sim_msg_finish(msg, NULL, NULL, 0); 426189251Ssam} 427189251Ssam 428189251Ssam 429189251Ssamstatic struct wpabuf * eap_sim_response_challenge(struct eap_sim_data *data, 430189251Ssam u8 id) 431189251Ssam{ 432189251Ssam struct eap_sim_msg *msg; 433189251Ssam 434189251Ssam wpa_printf(MSG_DEBUG, "Generating EAP-SIM Challenge (id=%d)", id); 435189251Ssam msg = eap_sim_msg_init(EAP_CODE_RESPONSE, id, EAP_TYPE_SIM, 436189251Ssam EAP_SIM_SUBTYPE_CHALLENGE); 437189251Ssam if (data->use_result_ind) { 438189251Ssam wpa_printf(MSG_DEBUG, " AT_RESULT_IND"); 439189251Ssam eap_sim_msg_add(msg, EAP_SIM_AT_RESULT_IND, 0, NULL, 0); 440189251Ssam } 441189251Ssam wpa_printf(MSG_DEBUG, " AT_MAC"); 442189251Ssam eap_sim_msg_add_mac(msg, EAP_SIM_AT_MAC); 443189251Ssam return eap_sim_msg_finish(msg, data->k_aut, (u8 *) data->sres, 444189251Ssam data->num_chal * EAP_SIM_SRES_LEN); 445189251Ssam} 446189251Ssam 447189251Ssam 448189251Ssamstatic struct wpabuf * eap_sim_response_reauth(struct eap_sim_data *data, 449252726Srpaulo u8 id, int counter_too_small, 450252726Srpaulo const u8 *nonce_s) 451189251Ssam{ 452189251Ssam struct eap_sim_msg *msg; 453189251Ssam unsigned int counter; 454189251Ssam 455189251Ssam wpa_printf(MSG_DEBUG, "Generating EAP-SIM Reauthentication (id=%d)", 456189251Ssam id); 457189251Ssam msg = eap_sim_msg_init(EAP_CODE_RESPONSE, id, EAP_TYPE_SIM, 458189251Ssam EAP_SIM_SUBTYPE_REAUTHENTICATION); 459189251Ssam wpa_printf(MSG_DEBUG, " AT_IV"); 460189251Ssam wpa_printf(MSG_DEBUG, " AT_ENCR_DATA"); 461189251Ssam eap_sim_msg_add_encr_start(msg, EAP_SIM_AT_IV, EAP_SIM_AT_ENCR_DATA); 462189251Ssam 463189251Ssam if (counter_too_small) { 464189251Ssam wpa_printf(MSG_DEBUG, " *AT_COUNTER_TOO_SMALL"); 465189251Ssam eap_sim_msg_add(msg, EAP_SIM_AT_COUNTER_TOO_SMALL, 0, NULL, 0); 466189251Ssam counter = data->counter_too_small; 467189251Ssam } else 468189251Ssam counter = data->counter; 469189251Ssam 470189251Ssam wpa_printf(MSG_DEBUG, " *AT_COUNTER %d", counter); 471189251Ssam eap_sim_msg_add(msg, EAP_SIM_AT_COUNTER, counter, NULL, 0); 472189251Ssam 473189251Ssam if (eap_sim_msg_add_encr_end(msg, data->k_encr, EAP_SIM_AT_PADDING)) { 474189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Failed to encrypt " 475189251Ssam "AT_ENCR_DATA"); 476189251Ssam eap_sim_msg_free(msg); 477189251Ssam return NULL; 478189251Ssam } 479189251Ssam if (data->use_result_ind) { 480189251Ssam wpa_printf(MSG_DEBUG, " AT_RESULT_IND"); 481189251Ssam eap_sim_msg_add(msg, EAP_SIM_AT_RESULT_IND, 0, NULL, 0); 482189251Ssam } 483189251Ssam wpa_printf(MSG_DEBUG, " AT_MAC"); 484189251Ssam eap_sim_msg_add_mac(msg, EAP_SIM_AT_MAC); 485252726Srpaulo return eap_sim_msg_finish(msg, data->k_aut, nonce_s, 486189251Ssam EAP_SIM_NONCE_S_LEN); 487189251Ssam} 488189251Ssam 489189251Ssam 490189251Ssamstatic struct wpabuf * eap_sim_response_notification(struct eap_sim_data *data, 491189251Ssam u8 id, u16 notification) 492189251Ssam{ 493189251Ssam struct eap_sim_msg *msg; 494189251Ssam u8 *k_aut = (notification & 0x4000) == 0 ? data->k_aut : NULL; 495189251Ssam 496189251Ssam wpa_printf(MSG_DEBUG, "Generating EAP-SIM Notification (id=%d)", id); 497189251Ssam msg = eap_sim_msg_init(EAP_CODE_RESPONSE, id, 498189251Ssam EAP_TYPE_SIM, EAP_SIM_SUBTYPE_NOTIFICATION); 499189251Ssam if (k_aut && data->reauth) { 500189251Ssam wpa_printf(MSG_DEBUG, " AT_IV"); 501189251Ssam wpa_printf(MSG_DEBUG, " AT_ENCR_DATA"); 502189251Ssam eap_sim_msg_add_encr_start(msg, EAP_SIM_AT_IV, 503189251Ssam EAP_SIM_AT_ENCR_DATA); 504189251Ssam wpa_printf(MSG_DEBUG, " *AT_COUNTER %d", data->counter); 505189251Ssam eap_sim_msg_add(msg, EAP_SIM_AT_COUNTER, data->counter, 506189251Ssam NULL, 0); 507189251Ssam if (eap_sim_msg_add_encr_end(msg, data->k_encr, 508189251Ssam EAP_SIM_AT_PADDING)) { 509189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Failed to encrypt " 510189251Ssam "AT_ENCR_DATA"); 511189251Ssam eap_sim_msg_free(msg); 512189251Ssam return NULL; 513189251Ssam } 514189251Ssam } 515189251Ssam if (k_aut) { 516189251Ssam wpa_printf(MSG_DEBUG, " AT_MAC"); 517189251Ssam eap_sim_msg_add_mac(msg, EAP_SIM_AT_MAC); 518189251Ssam } 519189251Ssam return eap_sim_msg_finish(msg, k_aut, (u8 *) "", 0); 520189251Ssam} 521189251Ssam 522189251Ssam 523189251Ssamstatic struct wpabuf * eap_sim_process_start(struct eap_sm *sm, 524189251Ssam struct eap_sim_data *data, u8 id, 525189251Ssam struct eap_sim_attrs *attr) 526189251Ssam{ 527189251Ssam int selected_version = -1, id_error; 528189251Ssam size_t i; 529189251Ssam u8 *pos; 530189251Ssam 531189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: subtype Start"); 532189251Ssam if (attr->version_list == NULL) { 533189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: No AT_VERSION_LIST in " 534189251Ssam "SIM/Start"); 535189251Ssam return eap_sim_client_error(data, id, 536189251Ssam EAP_SIM_UNSUPPORTED_VERSION); 537189251Ssam } 538189251Ssam 539189251Ssam os_free(data->ver_list); 540189251Ssam data->ver_list = os_malloc(attr->version_list_len); 541189251Ssam if (data->ver_list == NULL) { 542189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: Failed to allocate " 543189251Ssam "memory for version list"); 544189251Ssam return eap_sim_client_error(data, id, 545189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 546189251Ssam } 547189251Ssam os_memcpy(data->ver_list, attr->version_list, attr->version_list_len); 548189251Ssam data->ver_list_len = attr->version_list_len; 549189251Ssam pos = data->ver_list; 550189251Ssam for (i = 0; i < data->ver_list_len / 2; i++) { 551189251Ssam int ver = pos[0] * 256 + pos[1]; 552189251Ssam pos += 2; 553189251Ssam if (eap_sim_supported_ver(ver)) { 554189251Ssam selected_version = ver; 555189251Ssam break; 556189251Ssam } 557189251Ssam } 558189251Ssam if (selected_version < 0) { 559189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: Could not find a supported " 560189251Ssam "version"); 561189251Ssam return eap_sim_client_error(data, id, 562189251Ssam EAP_SIM_UNSUPPORTED_VERSION); 563189251Ssam } 564189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: Selected Version %d", 565189251Ssam selected_version); 566189251Ssam data->selected_version = selected_version; 567189251Ssam 568189251Ssam id_error = 0; 569189251Ssam switch (attr->id_req) { 570189251Ssam case NO_ID_REQ: 571189251Ssam break; 572189251Ssam case ANY_ID: 573189251Ssam if (data->num_id_req > 0) 574189251Ssam id_error++; 575189251Ssam data->num_id_req++; 576189251Ssam break; 577189251Ssam case FULLAUTH_ID: 578189251Ssam if (data->num_id_req > 1) 579189251Ssam id_error++; 580189251Ssam data->num_id_req++; 581189251Ssam break; 582189251Ssam case PERMANENT_ID: 583189251Ssam if (data->num_id_req > 2) 584189251Ssam id_error++; 585189251Ssam data->num_id_req++; 586189251Ssam break; 587189251Ssam } 588189251Ssam if (id_error) { 589189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: Too many ID requests " 590189251Ssam "used within one authentication"); 591189251Ssam return eap_sim_client_error(data, id, 592189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 593189251Ssam } 594189251Ssam 595189251Ssam return eap_sim_response_start(sm, data, id, attr->id_req); 596189251Ssam} 597189251Ssam 598189251Ssam 599189251Ssamstatic struct wpabuf * eap_sim_process_challenge(struct eap_sm *sm, 600189251Ssam struct eap_sim_data *data, 601189251Ssam u8 id, 602189251Ssam const struct wpabuf *reqData, 603189251Ssam struct eap_sim_attrs *attr) 604189251Ssam{ 605189251Ssam const u8 *identity; 606189251Ssam size_t identity_len; 607189251Ssam struct eap_sim_attrs eattr; 608189251Ssam 609189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: subtype Challenge"); 610189251Ssam data->reauth = 0; 611189251Ssam if (!attr->mac || !attr->rand) { 612189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Challenge message " 613189251Ssam "did not include%s%s", 614189251Ssam !attr->mac ? " AT_MAC" : "", 615189251Ssam !attr->rand ? " AT_RAND" : ""); 616189251Ssam return eap_sim_client_error(data, id, 617189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 618189251Ssam } 619189251Ssam 620189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: %lu challenges", 621189251Ssam (unsigned long) attr->num_chal); 622189251Ssam if (attr->num_chal < data->min_num_chal) { 623189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: Insufficient number of " 624189251Ssam "challenges (%lu)", (unsigned long) attr->num_chal); 625189251Ssam return eap_sim_client_error(data, id, 626189251Ssam EAP_SIM_INSUFFICIENT_NUM_OF_CHAL); 627189251Ssam } 628189251Ssam if (attr->num_chal > 3) { 629189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: Too many challenges " 630189251Ssam "(%lu)", (unsigned long) attr->num_chal); 631189251Ssam return eap_sim_client_error(data, id, 632189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 633189251Ssam } 634189251Ssam 635189251Ssam /* Verify that RANDs are different */ 636189251Ssam if (os_memcmp(attr->rand, attr->rand + GSM_RAND_LEN, 637189251Ssam GSM_RAND_LEN) == 0 || 638189251Ssam (attr->num_chal > 2 && 639189251Ssam (os_memcmp(attr->rand, attr->rand + 2 * GSM_RAND_LEN, 640189251Ssam GSM_RAND_LEN) == 0 || 641189251Ssam os_memcmp(attr->rand + GSM_RAND_LEN, 642189251Ssam attr->rand + 2 * GSM_RAND_LEN, 643189251Ssam GSM_RAND_LEN) == 0))) { 644189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: Same RAND used multiple times"); 645189251Ssam return eap_sim_client_error(data, id, 646189251Ssam EAP_SIM_RAND_NOT_FRESH); 647189251Ssam } 648189251Ssam 649189251Ssam os_memcpy(data->rand, attr->rand, attr->num_chal * GSM_RAND_LEN); 650189251Ssam data->num_chal = attr->num_chal; 651189251Ssam 652189251Ssam if (eap_sim_gsm_auth(sm, data)) { 653189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: GSM authentication failed"); 654189251Ssam return eap_sim_client_error(data, id, 655189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 656189251Ssam } 657189251Ssam if (data->last_eap_identity) { 658189251Ssam identity = data->last_eap_identity; 659189251Ssam identity_len = data->last_eap_identity_len; 660189251Ssam } else if (data->pseudonym) { 661189251Ssam identity = data->pseudonym; 662189251Ssam identity_len = data->pseudonym_len; 663189251Ssam } else 664189251Ssam identity = eap_get_config_identity(sm, &identity_len); 665189251Ssam wpa_hexdump_ascii(MSG_DEBUG, "EAP-SIM: Selected identity for MK " 666189251Ssam "derivation", identity, identity_len); 667189251Ssam eap_sim_derive_mk(identity, identity_len, data->nonce_mt, 668189251Ssam data->selected_version, data->ver_list, 669189251Ssam data->ver_list_len, data->num_chal, 670189251Ssam (const u8 *) data->kc, data->mk); 671189251Ssam eap_sim_derive_keys(data->mk, data->k_encr, data->k_aut, data->msk, 672189251Ssam data->emsk); 673189251Ssam if (eap_sim_verify_mac(data->k_aut, reqData, attr->mac, data->nonce_mt, 674189251Ssam EAP_SIM_NONCE_MT_LEN)) { 675189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Challenge message " 676189251Ssam "used invalid AT_MAC"); 677189251Ssam return eap_sim_client_error(data, id, 678189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 679189251Ssam } 680189251Ssam 681252726Srpaulo /* Old reauthentication identity must not be used anymore. In 682252726Srpaulo * other words, if no new reauth identity is received, full 683252726Srpaulo * authentication will be used on next reauthentication (using 684252726Srpaulo * pseudonym identity or permanent identity). */ 685252726Srpaulo eap_sim_clear_identities(sm, data, CLEAR_REAUTH_ID | CLEAR_EAP_ID); 686189251Ssam 687189251Ssam if (attr->encr_data) { 688189251Ssam u8 *decrypted; 689189251Ssam decrypted = eap_sim_parse_encr(data->k_encr, attr->encr_data, 690189251Ssam attr->encr_data_len, attr->iv, 691189251Ssam &eattr, 0); 692189251Ssam if (decrypted == NULL) { 693189251Ssam return eap_sim_client_error( 694189251Ssam data, id, EAP_SIM_UNABLE_TO_PROCESS_PACKET); 695189251Ssam } 696252726Srpaulo eap_sim_learn_ids(sm, data, &eattr); 697189251Ssam os_free(decrypted); 698189251Ssam } 699189251Ssam 700189251Ssam if (data->result_ind && attr->result_ind) 701189251Ssam data->use_result_ind = 1; 702189251Ssam 703189251Ssam if (data->state != FAILURE && data->state != RESULT_FAILURE) { 704189251Ssam eap_sim_state(data, data->use_result_ind ? 705189251Ssam RESULT_SUCCESS : SUCCESS); 706189251Ssam } 707189251Ssam 708189251Ssam data->num_id_req = 0; 709189251Ssam data->num_notification = 0; 710189251Ssam /* RFC 4186 specifies that counter is initialized to one after 711189251Ssam * fullauth, but initializing it to zero makes it easier to implement 712189251Ssam * reauth verification. */ 713189251Ssam data->counter = 0; 714189251Ssam return eap_sim_response_challenge(data, id); 715189251Ssam} 716189251Ssam 717189251Ssam 718189251Ssamstatic int eap_sim_process_notification_reauth(struct eap_sim_data *data, 719189251Ssam struct eap_sim_attrs *attr) 720189251Ssam{ 721189251Ssam struct eap_sim_attrs eattr; 722189251Ssam u8 *decrypted; 723189251Ssam 724189251Ssam if (attr->encr_data == NULL || attr->iv == NULL) { 725189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Notification message after " 726189251Ssam "reauth did not include encrypted data"); 727189251Ssam return -1; 728189251Ssam } 729189251Ssam 730189251Ssam decrypted = eap_sim_parse_encr(data->k_encr, attr->encr_data, 731189251Ssam attr->encr_data_len, attr->iv, &eattr, 732189251Ssam 0); 733189251Ssam if (decrypted == NULL) { 734189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Failed to parse encrypted " 735189251Ssam "data from notification message"); 736189251Ssam return -1; 737189251Ssam } 738189251Ssam 739189251Ssam if (eattr.counter < 0 || (size_t) eattr.counter != data->counter) { 740189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Counter in notification " 741189251Ssam "message does not match with counter in reauth " 742189251Ssam "message"); 743189251Ssam os_free(decrypted); 744189251Ssam return -1; 745189251Ssam } 746189251Ssam 747189251Ssam os_free(decrypted); 748189251Ssam return 0; 749189251Ssam} 750189251Ssam 751189251Ssam 752189251Ssamstatic int eap_sim_process_notification_auth(struct eap_sim_data *data, 753189251Ssam const struct wpabuf *reqData, 754189251Ssam struct eap_sim_attrs *attr) 755189251Ssam{ 756189251Ssam if (attr->mac == NULL) { 757189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: no AT_MAC in after_auth " 758189251Ssam "Notification message"); 759189251Ssam return -1; 760189251Ssam } 761189251Ssam 762189251Ssam if (eap_sim_verify_mac(data->k_aut, reqData, attr->mac, (u8 *) "", 0)) 763189251Ssam { 764189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Notification message " 765189251Ssam "used invalid AT_MAC"); 766189251Ssam return -1; 767189251Ssam } 768189251Ssam 769189251Ssam if (data->reauth && 770189251Ssam eap_sim_process_notification_reauth(data, attr)) { 771189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Invalid notification " 772189251Ssam "message after reauth"); 773189251Ssam return -1; 774189251Ssam } 775189251Ssam 776189251Ssam return 0; 777189251Ssam} 778189251Ssam 779189251Ssam 780189251Ssamstatic struct wpabuf * eap_sim_process_notification( 781189251Ssam struct eap_sm *sm, struct eap_sim_data *data, u8 id, 782189251Ssam const struct wpabuf *reqData, struct eap_sim_attrs *attr) 783189251Ssam{ 784189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: subtype Notification"); 785189251Ssam if (data->num_notification > 0) { 786189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: too many notification " 787189251Ssam "rounds (only one allowed)"); 788189251Ssam return eap_sim_client_error(data, id, 789189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 790189251Ssam } 791189251Ssam data->num_notification++; 792189251Ssam if (attr->notification == -1) { 793189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: no AT_NOTIFICATION in " 794189251Ssam "Notification message"); 795189251Ssam return eap_sim_client_error(data, id, 796189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 797189251Ssam } 798189251Ssam 799189251Ssam if ((attr->notification & 0x4000) == 0 && 800189251Ssam eap_sim_process_notification_auth(data, reqData, attr)) { 801189251Ssam return eap_sim_client_error(data, id, 802189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 803189251Ssam } 804189251Ssam 805189251Ssam eap_sim_report_notification(sm->msg_ctx, attr->notification, 0); 806189251Ssam if (attr->notification >= 0 && attr->notification < 32768) { 807189251Ssam eap_sim_state(data, FAILURE); 808189251Ssam } else if (attr->notification == EAP_SIM_SUCCESS && 809189251Ssam data->state == RESULT_SUCCESS) 810189251Ssam eap_sim_state(data, SUCCESS); 811189251Ssam return eap_sim_response_notification(data, id, attr->notification); 812189251Ssam} 813189251Ssam 814189251Ssam 815189251Ssamstatic struct wpabuf * eap_sim_process_reauthentication( 816189251Ssam struct eap_sm *sm, struct eap_sim_data *data, u8 id, 817189251Ssam const struct wpabuf *reqData, struct eap_sim_attrs *attr) 818189251Ssam{ 819189251Ssam struct eap_sim_attrs eattr; 820189251Ssam u8 *decrypted; 821189251Ssam 822189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: subtype Reauthentication"); 823189251Ssam 824189251Ssam if (data->reauth_id == NULL) { 825189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Server is trying " 826189251Ssam "reauthentication, but no reauth_id available"); 827189251Ssam return eap_sim_client_error(data, id, 828189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 829189251Ssam } 830189251Ssam 831189251Ssam data->reauth = 1; 832189251Ssam if (eap_sim_verify_mac(data->k_aut, reqData, attr->mac, (u8 *) "", 0)) 833189251Ssam { 834189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Reauthentication " 835189251Ssam "did not have valid AT_MAC"); 836189251Ssam return eap_sim_client_error(data, id, 837189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 838189251Ssam } 839189251Ssam 840189251Ssam if (attr->encr_data == NULL || attr->iv == NULL) { 841189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Reauthentication " 842189251Ssam "message did not include encrypted data"); 843189251Ssam return eap_sim_client_error(data, id, 844189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 845189251Ssam } 846189251Ssam 847189251Ssam decrypted = eap_sim_parse_encr(data->k_encr, attr->encr_data, 848189251Ssam attr->encr_data_len, attr->iv, &eattr, 849189251Ssam 0); 850189251Ssam if (decrypted == NULL) { 851189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Failed to parse encrypted " 852189251Ssam "data from reauthentication message"); 853189251Ssam return eap_sim_client_error(data, id, 854189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 855189251Ssam } 856189251Ssam 857189251Ssam if (eattr.nonce_s == NULL || eattr.counter < 0) { 858189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: (encr) No%s%s in reauth packet", 859189251Ssam !eattr.nonce_s ? " AT_NONCE_S" : "", 860189251Ssam eattr.counter < 0 ? " AT_COUNTER" : ""); 861189251Ssam os_free(decrypted); 862189251Ssam return eap_sim_client_error(data, id, 863189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 864189251Ssam } 865189251Ssam 866189251Ssam if (eattr.counter < 0 || (size_t) eattr.counter <= data->counter) { 867189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: (encr) Invalid counter " 868189251Ssam "(%d <= %d)", eattr.counter, data->counter); 869189251Ssam data->counter_too_small = eattr.counter; 870189251Ssam /* Reply using Re-auth w/ AT_COUNTER_TOO_SMALL. The current 871189251Ssam * reauth_id must not be used to start a new reauthentication. 872189251Ssam * However, since it was used in the last EAP-Response-Identity 873189251Ssam * packet, it has to saved for the following fullauth to be 874189251Ssam * used in MK derivation. */ 875189251Ssam os_free(data->last_eap_identity); 876189251Ssam data->last_eap_identity = data->reauth_id; 877189251Ssam data->last_eap_identity_len = data->reauth_id_len; 878189251Ssam data->reauth_id = NULL; 879189251Ssam data->reauth_id_len = 0; 880189251Ssam os_free(decrypted); 881252726Srpaulo return eap_sim_response_reauth(data, id, 1, eattr.nonce_s); 882189251Ssam } 883189251Ssam data->counter = eattr.counter; 884189251Ssam 885189251Ssam os_memcpy(data->nonce_s, eattr.nonce_s, EAP_SIM_NONCE_S_LEN); 886189251Ssam wpa_hexdump(MSG_DEBUG, "EAP-SIM: (encr) AT_NONCE_S", 887189251Ssam data->nonce_s, EAP_SIM_NONCE_S_LEN); 888189251Ssam 889189251Ssam eap_sim_derive_keys_reauth(data->counter, 890189251Ssam data->reauth_id, data->reauth_id_len, 891189251Ssam data->nonce_s, data->mk, data->msk, 892189251Ssam data->emsk); 893252726Srpaulo eap_sim_clear_identities(sm, data, CLEAR_REAUTH_ID | CLEAR_EAP_ID); 894252726Srpaulo eap_sim_learn_ids(sm, data, &eattr); 895189251Ssam 896189251Ssam if (data->result_ind && attr->result_ind) 897189251Ssam data->use_result_ind = 1; 898189251Ssam 899189251Ssam if (data->state != FAILURE && data->state != RESULT_FAILURE) { 900189251Ssam eap_sim_state(data, data->use_result_ind ? 901189251Ssam RESULT_SUCCESS : SUCCESS); 902189251Ssam } 903189251Ssam 904189251Ssam data->num_id_req = 0; 905189251Ssam data->num_notification = 0; 906189251Ssam if (data->counter > EAP_SIM_MAX_FAST_REAUTHS) { 907189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: Maximum number of " 908189251Ssam "fast reauths performed - force fullauth"); 909252726Srpaulo eap_sim_clear_identities(sm, data, 910252726Srpaulo CLEAR_REAUTH_ID | CLEAR_EAP_ID); 911189251Ssam } 912189251Ssam os_free(decrypted); 913252726Srpaulo return eap_sim_response_reauth(data, id, 0, data->nonce_s); 914189251Ssam} 915189251Ssam 916189251Ssam 917189251Ssamstatic struct wpabuf * eap_sim_process(struct eap_sm *sm, void *priv, 918189251Ssam struct eap_method_ret *ret, 919189251Ssam const struct wpabuf *reqData) 920189251Ssam{ 921189251Ssam struct eap_sim_data *data = priv; 922189251Ssam const struct eap_hdr *req; 923189251Ssam u8 subtype, id; 924189251Ssam struct wpabuf *res; 925189251Ssam const u8 *pos; 926189251Ssam struct eap_sim_attrs attr; 927189251Ssam size_t len; 928189251Ssam 929189251Ssam wpa_hexdump_buf(MSG_DEBUG, "EAP-SIM: EAP data", reqData); 930189251Ssam if (eap_get_config_identity(sm, &len) == NULL) { 931189251Ssam wpa_printf(MSG_INFO, "EAP-SIM: Identity not configured"); 932189251Ssam eap_sm_request_identity(sm); 933189251Ssam ret->ignore = TRUE; 934189251Ssam return NULL; 935189251Ssam } 936189251Ssam 937189251Ssam pos = eap_hdr_validate(EAP_VENDOR_IETF, EAP_TYPE_SIM, reqData, &len); 938189251Ssam if (pos == NULL || len < 1) { 939189251Ssam ret->ignore = TRUE; 940189251Ssam return NULL; 941189251Ssam } 942189251Ssam req = wpabuf_head(reqData); 943189251Ssam id = req->identifier; 944189251Ssam len = be_to_host16(req->length); 945189251Ssam 946189251Ssam ret->ignore = FALSE; 947189251Ssam ret->methodState = METHOD_MAY_CONT; 948189251Ssam ret->decision = DECISION_FAIL; 949189251Ssam ret->allowNotifications = TRUE; 950189251Ssam 951189251Ssam subtype = *pos++; 952189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: Subtype=%d", subtype); 953189251Ssam pos += 2; /* Reserved */ 954189251Ssam 955189251Ssam if (eap_sim_parse_attr(pos, wpabuf_head_u8(reqData) + len, &attr, 0, 956189251Ssam 0)) { 957189251Ssam res = eap_sim_client_error(data, id, 958189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 959189251Ssam goto done; 960189251Ssam } 961189251Ssam 962189251Ssam switch (subtype) { 963189251Ssam case EAP_SIM_SUBTYPE_START: 964189251Ssam res = eap_sim_process_start(sm, data, id, &attr); 965189251Ssam break; 966189251Ssam case EAP_SIM_SUBTYPE_CHALLENGE: 967189251Ssam res = eap_sim_process_challenge(sm, data, id, reqData, &attr); 968189251Ssam break; 969189251Ssam case EAP_SIM_SUBTYPE_NOTIFICATION: 970189251Ssam res = eap_sim_process_notification(sm, data, id, reqData, 971189251Ssam &attr); 972189251Ssam break; 973189251Ssam case EAP_SIM_SUBTYPE_REAUTHENTICATION: 974189251Ssam res = eap_sim_process_reauthentication(sm, data, id, reqData, 975189251Ssam &attr); 976189251Ssam break; 977189251Ssam case EAP_SIM_SUBTYPE_CLIENT_ERROR: 978189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: subtype Client-Error"); 979189251Ssam res = eap_sim_client_error(data, id, 980189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 981189251Ssam break; 982189251Ssam default: 983189251Ssam wpa_printf(MSG_DEBUG, "EAP-SIM: Unknown subtype=%d", subtype); 984189251Ssam res = eap_sim_client_error(data, id, 985189251Ssam EAP_SIM_UNABLE_TO_PROCESS_PACKET); 986189251Ssam break; 987189251Ssam } 988189251Ssam 989189251Ssamdone: 990189251Ssam if (data->state == FAILURE) { 991189251Ssam ret->decision = DECISION_FAIL; 992189251Ssam ret->methodState = METHOD_DONE; 993189251Ssam } else if (data->state == SUCCESS) { 994189251Ssam ret->decision = data->use_result_ind ? 995189251Ssam DECISION_UNCOND_SUCC : DECISION_COND_SUCC; 996189251Ssam ret->methodState = data->use_result_ind ? 997189251Ssam METHOD_DONE : METHOD_MAY_CONT; 998189251Ssam } else if (data->state == RESULT_FAILURE) 999189251Ssam ret->methodState = METHOD_CONT; 1000189251Ssam else if (data->state == RESULT_SUCCESS) 1001189251Ssam ret->methodState = METHOD_CONT; 1002189251Ssam 1003189251Ssam if (ret->methodState == METHOD_DONE) { 1004189251Ssam ret->allowNotifications = FALSE; 1005189251Ssam } 1006189251Ssam 1007189251Ssam return res; 1008189251Ssam} 1009189251Ssam 1010189251Ssam 1011189251Ssamstatic Boolean eap_sim_has_reauth_data(struct eap_sm *sm, void *priv) 1012189251Ssam{ 1013189251Ssam struct eap_sim_data *data = priv; 1014189251Ssam return data->pseudonym || data->reauth_id; 1015189251Ssam} 1016189251Ssam 1017189251Ssam 1018189251Ssamstatic void eap_sim_deinit_for_reauth(struct eap_sm *sm, void *priv) 1019189251Ssam{ 1020189251Ssam struct eap_sim_data *data = priv; 1021252726Srpaulo eap_sim_clear_identities(sm, data, CLEAR_EAP_ID); 1022189251Ssam data->use_result_ind = 0; 1023189251Ssam} 1024189251Ssam 1025189251Ssam 1026189251Ssamstatic void * eap_sim_init_for_reauth(struct eap_sm *sm, void *priv) 1027189251Ssam{ 1028189251Ssam struct eap_sim_data *data = priv; 1029252726Srpaulo if (random_get_bytes(data->nonce_mt, EAP_SIM_NONCE_MT_LEN)) { 1030189251Ssam wpa_printf(MSG_WARNING, "EAP-SIM: Failed to get random data " 1031189251Ssam "for NONCE_MT"); 1032189251Ssam os_free(data); 1033189251Ssam return NULL; 1034189251Ssam } 1035189251Ssam data->num_id_req = 0; 1036189251Ssam data->num_notification = 0; 1037189251Ssam eap_sim_state(data, CONTINUE); 1038189251Ssam return priv; 1039189251Ssam} 1040189251Ssam 1041189251Ssam 1042189251Ssamstatic const u8 * eap_sim_get_identity(struct eap_sm *sm, void *priv, 1043189251Ssam size_t *len) 1044189251Ssam{ 1045189251Ssam struct eap_sim_data *data = priv; 1046189251Ssam 1047189251Ssam if (data->reauth_id) { 1048189251Ssam *len = data->reauth_id_len; 1049189251Ssam return data->reauth_id; 1050189251Ssam } 1051189251Ssam 1052189251Ssam if (data->pseudonym) { 1053189251Ssam *len = data->pseudonym_len; 1054189251Ssam return data->pseudonym; 1055189251Ssam } 1056189251Ssam 1057189251Ssam return NULL; 1058189251Ssam} 1059189251Ssam 1060189251Ssam 1061189251Ssamstatic Boolean eap_sim_isKeyAvailable(struct eap_sm *sm, void *priv) 1062189251Ssam{ 1063189251Ssam struct eap_sim_data *data = priv; 1064189251Ssam return data->state == SUCCESS; 1065189251Ssam} 1066189251Ssam 1067189251Ssam 1068189251Ssamstatic u8 * eap_sim_getKey(struct eap_sm *sm, void *priv, size_t *len) 1069189251Ssam{ 1070189251Ssam struct eap_sim_data *data = priv; 1071189251Ssam u8 *key; 1072189251Ssam 1073189251Ssam if (data->state != SUCCESS) 1074189251Ssam return NULL; 1075189251Ssam 1076189251Ssam key = os_malloc(EAP_SIM_KEYING_DATA_LEN); 1077189251Ssam if (key == NULL) 1078189251Ssam return NULL; 1079189251Ssam 1080189251Ssam *len = EAP_SIM_KEYING_DATA_LEN; 1081189251Ssam os_memcpy(key, data->msk, EAP_SIM_KEYING_DATA_LEN); 1082189251Ssam 1083189251Ssam return key; 1084189251Ssam} 1085189251Ssam 1086189251Ssam 1087189251Ssamstatic u8 * eap_sim_get_emsk(struct eap_sm *sm, void *priv, size_t *len) 1088189251Ssam{ 1089189251Ssam struct eap_sim_data *data = priv; 1090189251Ssam u8 *key; 1091189251Ssam 1092189251Ssam if (data->state != SUCCESS) 1093189251Ssam return NULL; 1094189251Ssam 1095189251Ssam key = os_malloc(EAP_EMSK_LEN); 1096189251Ssam if (key == NULL) 1097189251Ssam return NULL; 1098189251Ssam 1099189251Ssam *len = EAP_EMSK_LEN; 1100189251Ssam os_memcpy(key, data->emsk, EAP_EMSK_LEN); 1101189251Ssam 1102189251Ssam return key; 1103189251Ssam} 1104189251Ssam 1105189251Ssam 1106189251Ssamint eap_peer_sim_register(void) 1107189251Ssam{ 1108189251Ssam struct eap_method *eap; 1109189251Ssam int ret; 1110189251Ssam 1111189251Ssam eap = eap_peer_method_alloc(EAP_PEER_METHOD_INTERFACE_VERSION, 1112189251Ssam EAP_VENDOR_IETF, EAP_TYPE_SIM, "SIM"); 1113189251Ssam if (eap == NULL) 1114189251Ssam return -1; 1115189251Ssam 1116189251Ssam eap->init = eap_sim_init; 1117189251Ssam eap->deinit = eap_sim_deinit; 1118189251Ssam eap->process = eap_sim_process; 1119189251Ssam eap->isKeyAvailable = eap_sim_isKeyAvailable; 1120189251Ssam eap->getKey = eap_sim_getKey; 1121189251Ssam eap->has_reauth_data = eap_sim_has_reauth_data; 1122189251Ssam eap->deinit_for_reauth = eap_sim_deinit_for_reauth; 1123189251Ssam eap->init_for_reauth = eap_sim_init_for_reauth; 1124189251Ssam eap->get_identity = eap_sim_get_identity; 1125189251Ssam eap->get_emsk = eap_sim_get_emsk; 1126189251Ssam 1127189251Ssam ret = eap_peer_method_register(eap); 1128189251Ssam if (ret) 1129189251Ssam eap_peer_method_free(eap); 1130189251Ssam return ret; 1131189251Ssam} 1132