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