/*--------------------------------------------------------------------------
Copyright (c) 2013, The Linux Foundation. All rights reserved.

Redistribution and use in source and binary forms, with or without
modification, are permitted provided that the following conditions are
met:
    * Redistributions of source code must retain the above copyright
      notice, this list of conditions and the following disclaimer.
    * Redistributions in binary form must reproduce the above
      copyright notice, this list of conditions and the following
      disclaimer in the documentation and/or other materials provided
      with the distribution.
    * Neither the name of The Linux Foundation nor the names of its
      contributors may be used to endorse or promote products derived
      from this software without specific prior written permission.

THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
--------------------------------------------------------------------------*/

#include "includes.h"
#include "common.h"

#ifdef CONFIG_EAP_PROXY
#include "qmi_client.h"
#include "eap_proxy_qmi_oc.h"
#include "qmi_client.h"
#include "qmi_idl_lib.h"
#include "authentication_service_v01.h"
#include "user_identity_module_v01.h"
#include "eap_config.h"
#include "common/wpa_ctrl.h"
#if defined(ANDROID)
#include <cutils/properties.h>
#ifdef CONFIG_EAP_PROXY_MDM_DETECT
#include "mdm_detect.h"
#endif /* CONFIG_EAP_PROXY_MDM_DETECT */
#if defined(__BIONIC_FORTIFY)
#include <sys/system_properties.h>
#endif
#endif
#include <pthread.h>
#include <sys/syscall.h>
#include <sys/types.h>

#define IMSI_LENGTH 15
#define WPA_UIM_QMI_EVENT_MASK_CARD_STATUS        \
                                        (1 << QMI_UIM_EVENT_CARD_STATUS_BIT_V01)
#define WPA_UIM_QMI_EVENT_READ_TRANSPARENT_REQ    \
                                        (1 << QMI_UIM_READ_TRANSPARENT_REQ_V01)

/* Default timeout (in milli-seconds) for synchronous QMI message */
#define WPA_UIM_QMI_DEFAULT_TIMEOUT               5000

#define EAP_PROXY_PROPERTY_BASEBAND     "ro.baseband"
#ifdef CONFIG_EAP_PROXY_MSM8994_TARGET
#define EAP_PROXY_TARGET_PLATFORM       "ro.board.platform"
#endif /* CONFIG_EAP_PROXY_MSM8994_TARGET */
#if defined(__BIONIC_FORTIFY)
#define EAP_PROXY_PROPERTY_BASEBAND_SIZE   PROP_VALUE_MAX
#else
#define EAP_PROXY_PROPERTY_BASEBAND_SIZE   10
#endif
#define EAP_PROXY_BASEBAND_VALUE_MSM       "msm"
#define EAP_PROXY_BASEBAND_VALUE_APQ       "apq"
#define EAP_PROXY_BASEBAND_VALUE_SVLTE1    "svlte1"
#define EAP_PROXY_BASEBAND_VALUE_SVLTE2A   "svlte2a"
#define EAP_PROXY_BASEBAND_VALUE_SGLTE     "sglte"
#define EAP_PROXY_BASEBAND_VALUE_CSFB      "csfb"
#define EAP_PROXY_BASEBAND_VALUE_MDMUSB    "mdm"
#ifdef CONFIG_EAP_PROXY_MSM8994_TARGET
#define EAP_PROXY_TARGET_PLATFORM_MSM8994  "msm8994"
#endif /* CONFIG_EAP_PROXY_MSM8994_TARGET */
#define EAP_PROXY_TARGET_FUSION4_5_PCIE    "fusion4_5_pcie"
#define EAP_PROXY_BASEBAND_VALUE_UNDEFINED "undefined"

#ifndef ANDROID
#ifdef SYS_gettid
static inline pid_t gettid(void)
{
        return syscall(SYS_gettid);
}
#else
static inline pid_t gettid(void)
{
        return -1;
}
#endif
#endif

static Boolean wpa_qmi_ssr = FALSE;
static void eap_proxy_qmi_deinit(struct eap_proxy_sm *eap_proxy);
static void eap_proxy_eapol_sm_set_bool(struct eap_proxy_sm *sm,
                         enum eapol_bool_var var, Boolean value);
struct eap_proxy_sm *
eap_proxy_init(void *eapol_ctx, const struct eapol_callbacks *eapol_cb,
	       void *msg_ctx);
static Boolean eap_proxy_eapol_sm_get_bool(struct eap_proxy_sm *sm,
                                        enum eapol_bool_var var);

/* Call-back function to process an authenticationr result indication from
 * QMI EAP service */
static void handle_qmi_eap_ind(qmi_client_type user_handle,
                unsigned int msg_id,
                void* ind_buf,
                unsigned int ind_buf_len,
                void* ind_cb_data);

static u8 *eap_proxy_getKey(struct eap_proxy_sm *eap_proxy);
static enum eap_proxy_status eap_proxy_qmi_response_wait(struct eap_proxy_sm *eap_proxy);
static int eap_proxy_is_state_changed(struct eap_proxy_sm *sm);
static enum eap_proxy_status eap_proxy_process(struct eap_proxy_sm  *eap_proxy,
                                        u8 *eapReqData, int eapReqDataLen, struct eap_sm *eap_sm);
static char bin_to_hexchar(u8 ch);

static void wpa_qmi_client_indication_cb
(
        qmi_client_type                user_handle,
        unsigned long                  msg_id,
        unsigned char                 *ind_buf_ptr,
        int                            ind_buf_len,
        void                          *ind_cb_data
);
static void dump_buff(u8 *buff, int len);
#ifdef CONFIG_CTRL_IFACE
static const char *eap_proxy_sm_state_txt(int state);
#endif /* CONFIG_CTRL_IFACE */
static Boolean eap_proxy_build_identity(struct eap_proxy_sm *eap_proxy, u8 id,
                                                 struct eap_sm *eap_sm);

#ifdef SIM_AKA_IDENTITY_IMSI
static char *imsi;
static int imsi_len_g = 0;
static int card_mnc_len = -1;
#ifdef CONFIG_EAP_PROXY_DUAL_SIM
static unsigned int slot = 0;
static unsigned int session_type;
#endif /* CONFIG_EAP_PROXY_DUAL_SIM */

static Boolean wpa_qmi_register_events(int sim_num, wpa_uim_struct_type *wpa_uim);
static Boolean wpa_qmi_read_card_imsi(int sim_num, wpa_uim_struct_type *wpa_uim);
static Boolean wpa_qmi_read_card_status(int sim_num, wpa_uim_struct_type *wpa_uim);
static Boolean wpa_qmi_register_auth_inds(struct eap_proxy_sm *eap_proxy);

#endif
#define EAP_SUB_TYPE_SIM_START     0x0a
#define EAP_SUB_TYPE_AKA_IDENTITY  0x05
#define EAP_RESP_TYPE_NAK             3


#ifdef SIM_AKA_IDENTITY_IMSI
static void wpa_qmi_client_indication_cb
(
        qmi_client_type                user_handle,
        unsigned long                  msg_id,
        unsigned char                 *ind_buf_ptr,
        int                            ind_buf_len,
        void                          *ind_cb_data
)
{
	u32 decoded_payload_len = 0;
	qmi_client_error_type qmi_err = QMI_NO_ERR;
	void * decoded_payload = NULL;
	struct eap_proxy_sm *eap_proxy = ind_cb_data;
	uim_status_change_ind_msg_v01* status_change_ind_ptr = NULL;
	struct wpa_supplicant *wpa_s = NULL;
	u32 i, card_info_len = 0;

	wpa_printf(MSG_DEBUG, "eap_proxy: %s: msg_id=0x%lx", __func__, msg_id);

	if (user_handle == NULL) {
		wpa_printf(MSG_ERROR, "eap_proxy: qmi_client_type missing in callback");
		return;
	}

	if (eap_proxy == NULL) {
		wpa_printf(MSG_ERROR, "eap_proxy: not initialized, discard client indiataion");
		return;
	}

	if (ind_buf_ptr == NULL) {
		wpa_printf(MSG_ERROR, "eap_proxy: indication buffer NULL, discard client indiataion");
		return;
	}

	qmi_idl_get_message_c_struct_len(uim_get_service_object_v01(),
					 QMI_IDL_INDICATION, msg_id,
					 &decoded_payload_len);

	if(!decoded_payload_len) {
		wpa_printf(MSG_ERROR, "eap_proxy: cann't decode payload, discard client indiataion");
		return;
	}

	decoded_payload = os_zalloc(decoded_payload_len);
	if (decoded_payload == NULL) {
		wpa_printf(MSG_ERROR, "eap_proxy: failed to allocate memory");
		return;
	}

	qmi_err = qmi_client_message_decode(user_handle,
					    QMI_IDL_INDICATION, msg_id,
					    ind_buf_ptr, ind_buf_len,
					    decoded_payload, decoded_payload_len);

	if (qmi_err == QMI_NO_ERR) {
		switch (msg_id) {
		case QMI_UIM_STATUS_CHANGE_IND_V01:
			status_change_ind_ptr = (uim_status_change_ind_msg_v01*)decoded_payload;
			if (!status_change_ind_ptr->card_status_valid)
				goto fail;

			card_info_len = status_change_ind_ptr->card_status.card_info_len;
			for (i = 0; i < card_info_len; i++) {
				if(UIM_CARD_STATE_PRESENT_V01 !=
				    status_change_ind_ptr->card_status.card_info[i].card_state) {
					wpa_printf(MSG_DEBUG, "eap_proxy: %s SIM card removed. flush pmksa entries.", __func__);
					eap_proxy->eapol_cb->eap_proxy_notify_sim_status(eap_proxy->ctx, SIM_STATE_ERROR);
					break; /* only one flush will do */
				}
			}
			break;
		default:
			wpa_printf(MSG_DEBUG, "eap_proxy: Unknown QMI Indicaiton %lu", msg_id);
			break;
		}
	}
fail:
	os_free(decoded_payload);
	return;
}

static Boolean wpa_qmi_register_auth_inds(struct eap_proxy_sm *eap_proxy)
{
        qmi_client_error_type               qmi_err_code      = 0;
        auth_indication_register_resp_msg_v01  event_resp_msg;
        auth_indication_register_req_msg_v01 event_reg_params;

        /* Register for events first */
        os_memset(&event_reg_params, 0, sizeof(auth_indication_register_req_msg_v01));
        os_memset(&event_resp_msg, 0, sizeof(auth_indication_register_resp_msg_v01));

        event_reg_params.report_eap_notification_code_valid = TRUE;
        event_reg_params.report_eap_notification_code = 1;

        wpa_printf(MSG_DEBUG, "registering for notification codes\n");
        qmi_err_code = qmi_client_send_msg_sync(
                        eap_proxy->qmi_auth_svc_client_ptr[eap_proxy->user_selected_sim],
                        QMI_AUTH_INDICATION_REGISTER_REQ_V01,
                        (void *) &event_reg_params,
                        sizeof(auth_indication_register_req_msg_v01),
                        (void*) &event_resp_msg,
                        sizeof(auth_indication_register_resp_msg_v01),
                        WPA_UIM_QMI_DEFAULT_TIMEOUT);

        if (qmi_err_code != QMI_NO_ERR ||
            (event_resp_msg.resp.result != QMI_RESULT_SUCCESS_V01 &&
             event_resp_msg.resp.error != QMI_ERR_NO_EFFECT_V01)) {
                wpa_printf(MSG_ERROR,"QMI-ERROR Error for "
                           "QMI_AUTH_INDICATION_REGISTER_REQ_V01, qmi_err_code=%d"
                           "Error=%d\n", qmi_err_code,
                            event_resp_msg.resp.error);
                return FALSE;
        }

        return TRUE;

}

static Boolean wpa_qmi_register_events(int sim_num, wpa_uim_struct_type *wpa_uim)
{
        qmi_client_error_type               qmi_err_code      = 0;
        uim_event_reg_resp_msg_v01          event_resp_msg;
        uim_event_reg_req_msg_v01           event_reg_params;

        /* Register for events first */
        os_memset(&event_reg_params, 0, sizeof(uim_event_reg_req_msg_v01));
        os_memset(&event_resp_msg, 0, sizeof(uim_event_reg_resp_msg_v01));

        event_reg_params.event_mask |= (WPA_UIM_QMI_EVENT_MASK_CARD_STATUS);
        qmi_err_code = qmi_client_send_msg_sync(wpa_uim[sim_num].qmi_uim_svc_client_ptr,
                                                QMI_UIM_EVENT_REG_REQ_V01,
                                                (void *) &event_reg_params,
                                                sizeof(uim_event_reg_req_msg_v01),
                                                (void *) &event_resp_msg,
                                                sizeof(uim_event_reg_resp_msg_v01),
                                                WPA_UIM_QMI_DEFAULT_TIMEOUT);

        wpa_printf(MSG_ERROR, "eap_proxy: QMI_UIM_EVENT_REG_REQ_V01, "
                   "qmi_err_code: 0x%x wpa_uim[%d].qmi_uim_svc_client_ptr =%p"
                   "Error=0x%x", qmi_err_code, sim_num,
                    wpa_uim[sim_num].qmi_uim_svc_client_ptr,
                    event_resp_msg.resp.error);

        if (qmi_err_code != QMI_NO_ERR ||
            (event_resp_msg.resp.result != QMI_RESULT_SUCCESS_V01 &&
             event_resp_msg.resp.error != QMI_ERR_NO_EFFECT_V01)) {
                wpa_printf(MSG_ERROR,"QMI-ERROR Error for "
                           "QMI_UIM_EVENT_REG_REQ_V01, qmi_err_code=%d"
                           "Error=%d\n", qmi_err_code,
                            event_resp_msg.resp.error);
                return FALSE;
        }

        if(event_resp_msg.event_mask_valid)
        {
                wpa_printf(MSG_ERROR, "eap_proxy: event_resp_msg.event=%d,\n",
                           event_resp_msg.event_mask);

        }

        if (wpa_qmi_read_card_status(sim_num, wpa_uim))
                return TRUE;
        else {
                wpa_printf(MSG_ERROR,"eap_proxy: Error while reading SIM card status\n");
                return FALSE;
        }
}

static Boolean wpa_qmi_read_card_status(int sim_num, wpa_uim_struct_type *wpa_uim)
{
        unsigned int                        i = 0, j = 0;
        Boolean                             card_found = FALSE;
        qmi_client_error_type               qmi_err_code      = 0;
        uim_get_card_status_resp_msg_v01   card_status_resp_msg;

        wpa_printf (MSG_ERROR, "eap_proxy: reading card %d values\n", sim_num+1);
        os_memset(&card_status_resp_msg,
                  0,
                  sizeof(uim_get_card_status_resp_msg_v01));
        qmi_err_code = qmi_client_send_msg_sync(wpa_uim[sim_num].qmi_uim_svc_client_ptr,
                                                QMI_UIM_GET_CARD_STATUS_REQ_V01,
                                                NULL,
                                                0,
                                                (void *)&card_status_resp_msg,
                                                sizeof(uim_get_card_status_resp_msg_v01),
                                                WPA_UIM_QMI_DEFAULT_TIMEOUT);

        if (qmi_err_code != QMI_NO_ERR ||
            card_status_resp_msg.resp.result != QMI_RESULT_SUCCESS_V01) {
                wpa_printf(MSG_ERROR, "QMI-ERROR Error for "
                           "QMI_UIM_GET_CARD_STATUS_REQ_V01, qmi_err_code: 0x%x\n "
                           "resp_err = %d \n", qmi_err_code, card_status_resp_msg.resp.error);
                return FALSE;
        }

        /* Updated global card status if needed */
        if (!card_status_resp_msg.card_status_valid ||
            (card_status_resp_msg.resp.result != QMI_RESULT_SUCCESS_V01)) {
                wpa_printf(MSG_ERROR, "eap_proxy: card_status is not valid !\n");
                return FALSE;
        }
        /* Update global in case of new card state or error code */
        i = sim_num;
        if ( i < QMI_UIM_CARDS_MAX_V01 &&
             i < card_status_resp_msg.card_status.card_info_len ) {
                wpa_printf(MSG_ERROR, "eap_proxy: card_info[i].card_state: 0x%x\n",
                        card_status_resp_msg.card_status.card_info[i].card_state);
                wpa_printf(MSG_ERROR, "eap_proxy: card_info[i].error_code: 0x%x\n",
                        card_status_resp_msg.card_status.card_info[i].error_code);

                wpa_uim[sim_num].card_info[i].card_state =
                        card_status_resp_msg.card_status.card_info[i].card_state;

                wpa_uim[sim_num].card_info[i].card_error_code =
                        card_status_resp_msg.card_status.card_info[i].error_code;
#ifdef CONFIG_EAP_PROXY_DUAL_SIM
            do {
                   if (card_status_resp_msg.card_status.index_gw_pri != 0xFFFF) {
                        slot = (card_status_resp_msg.card_status.index_gw_pri & 0xFF00) >> 8;
                        if (slot == i) {
                            session_type = UIM_SESSION_TYPE_PRIMARY_GW_V01;
                            wpa_printf (MSG_ERROR, "eap_proxy: read_card_status:"
                                        " prime slot = %d\n", slot);
                            break;
                        }
                   }
                   if (card_status_resp_msg.card_status.index_gw_sec != 0xFFFF) {
                        slot = (card_status_resp_msg.card_status.index_gw_sec & 0xFF00) >> 8;
                        if (slot == i) {
                            session_type = UIM_SESSION_TYPE_SECONDARY_GW_V01;
                            wpa_printf (MSG_ERROR, "eap_proxy: read_card_status: "
                                        "second slot = %d\n", slot);
                            break;
                        }
                   }
                   wpa_printf (MSG_ERROR, "eap_proxy: read_card_status: Not GW it's 1x\n");
                   return FALSE;
                }while(0);

                if (slot > 1){
                            wpa_printf (MSG_ERROR, "eap_proxy: read_card_status: "
                                        "INVALID slot = %d and i = %d\n", slot, i);
                        return FALSE;
                }
#endif /* CONFIG_EAP_PROXY_DUAL_SIM */

                if (card_status_resp_msg.card_status.card_info[i].card_state ==
                    UIM_CARD_STATE_PRESENT_V01) {
                        for (j = 0 ; j < QMI_UIM_APPS_MAX_V01 ; j++) {
                                wpa_uim[sim_num].card_info[i].app_type = card_status_resp_msg.
                                        card_status.card_info[i].app_info[j].app_type;

                                wpa_uim[sim_num].card_info[i].app_state = card_status_resp_msg.
                                        card_status.card_info[i].app_info[j].app_state;

                                if (((card_status_resp_msg.card_status.card_info[i].
                                     app_info[j].app_type == 1) || (card_status_resp_msg.
                                     card_status.card_info[i].app_info[j].app_type == 2)) &&
                                    (card_status_resp_msg.card_status.card_info[i].app_info[j].
                                     app_state == UIM_APP_STATE_READY_V01)) {
                                        wpa_printf(MSG_ERROR, "eap_proxy: card READY\n");
                                        wpa_printf(MSG_ERROR, "eap_proxy: card_info[i].app_ty"
                                                "pe: 0x%x\n", card_status_resp_msg.card_status.
                                                card_info[i].app_info[j].app_type);
                                        wpa_printf(MSG_ERROR, "eap_proxy: card_info[i].app_sta"
                                                "te : 0x%x\n", card_status_resp_msg.card_status
                                                .card_info[i].app_info[j].app_state);
                                        card_found = TRUE;
                                        break;
                                }
                        }
                }

                if (card_found) {
                        wpa_printf(MSG_ERROR, "eap_proxy: card found for SIM = %d\n", sim_num+1);
                }
        }

        if ((!card_found) || (i == QMI_UIM_CARDS_MAX_V01) ||
                (j == QMI_UIM_APPS_MAX_V01)) {
                wpa_printf(MSG_ERROR, "eap_proxy: SIM/USIM not ready card_found=%d\n",card_found);
                return FALSE;
        }

        wpa_printf(MSG_ERROR, "eap_proxy: SIM/USIM ready\n");
        wpa_uim[sim_num].card_ready_idx = i;

        return TRUE;
} /* wpa_qmi_read_card_status */

static int check_for_3_digit()
{
        int mcc = 0,i =0;
        /*
        -- 3 digits if MCC belongs to this group: 302, 310, 311, 312, 313, 314, 315,
        316, 334, 348 (decimal)
        -- 2 digits in all other cases
        Note: imsi values are hex characters
        */
        int valid_mcc[] = {302, 310, 311, 312, 313, 314, 315, 316, 334, 348};

        mcc = ((imsi[0]-0x30)*100) + ((imsi[1]-0x30)*10) + (imsi[2]-0x30);

        wpa_printf(MSG_ERROR, "mcc from the SIM is %d\n", mcc);
        for(i = 0; i < sizeof(valid_mcc)/sizeof(valid_mcc[0]); i++)
        {
                if(mcc == valid_mcc[i])
                        return 1;
        }
        return 0;
}

static Boolean wpa_qmi_read_card_imsi(int sim_num, wpa_uim_struct_type *wpa_uim)
{
        int                     length;
        unsigned char           *data;
        int                     src = 0, dst = 0;
        Boolean                 card_found = FALSE,
        qmi_status = TRUE;
        qmi_client_error_type               qmi_err_code = 0;
        uim_read_transparent_req_msg_v01   qmi_read_trans_req;
        uim_read_transparent_resp_msg_v01  read_trans_resp;
        card_mnc_len = -1;


        os_memset(&read_trans_resp, 0,
                  sizeof(uim_read_transparent_resp_msg_v01));
        os_memset(&qmi_read_trans_req, 0,
                        sizeof(uim_read_transparent_req_msg_v01));

        qmi_read_trans_req.read_transparent.length = 0;
        qmi_read_trans_req.read_transparent.offset = 0;
        qmi_read_trans_req.file_id.file_id = 0x6F07;
        qmi_read_trans_req.file_id.path_len = 4;

#ifdef CONFIG_EAP_PROXY_DUAL_SIM
        wpa_printf (MSG_ERROR, "eap_proxy: read_card_imsi: session_type = %d\n", session_type);
        qmi_read_trans_req.session_information.session_type = session_type;
#else
        qmi_read_trans_req.session_information.session_type =
                                UIM_SESSION_TYPE_PRIMARY_GW_V01;
#endif /* CONFIG_EAP_PROXY_DUAL_SIM */
        qmi_read_trans_req.session_information.aid_len = 0;

        /* For USIM*/
        if ((wpa_uim[sim_num].card_info[wpa_uim[sim_num].card_ready_idx].app_type ==
                UIM_APP_TYPE_USIM_V01)) {
                qmi_read_trans_req.file_id.path[0] = 0x00;
                qmi_read_trans_req.file_id.path[1] = 0x3F;
                qmi_read_trans_req.file_id.path[2] = 0xFF;
                qmi_read_trans_req.file_id.path[3] = 0x7F;

        } else /* For SIM*/
        if ((wpa_uim[sim_num].card_info[wpa_uim[sim_num].card_ready_idx].app_type ==
                UIM_APP_TYPE_SIM_V01)) {
                qmi_read_trans_req.file_id.path[0] = 0x00;
                qmi_read_trans_req.file_id.path[1] = 0x3F;
                qmi_read_trans_req.file_id.path[2] = 0x20;
                qmi_read_trans_req.file_id.path[3] = 0x7F;
        }
        else {
                return FALSE;
        }

        qmi_err_code = qmi_client_send_msg_sync(wpa_uim[sim_num].qmi_uim_svc_client_ptr,
                                        QMI_UIM_READ_TRANSPARENT_REQ_V01,
                                        (void *)&qmi_read_trans_req,
                                        sizeof(uim_read_transparent_req_msg_v01),
                                        (void *) &read_trans_resp,
                                        sizeof(uim_read_transparent_resp_msg_v01),
                                        WPA_UIM_QMI_DEFAULT_TIMEOUT);
        if (QMI_NO_ERR != qmi_err_code ||
            read_trans_resp.resp.result != QMI_RESULT_SUCCESS_V01) {
                wpa_printf(MSG_ERROR, "QMI-ERROR Unable to read IMSI from UIM service;"
                           " error_ret=%d; qmi_err=%d\n", qmi_err_code,
                           read_trans_resp.resp.error);
                qmi_status = FALSE;
        }

        if (QMI_NO_ERR == qmi_err_code) {
                if (read_trans_resp.read_result_valid) {
                        length  =
                                read_trans_resp.read_result.content_len;
                        data    =
                                read_trans_resp.read_result.content;
                                wpa_printf(MSG_ERROR,
                                        "eap_proxy: IMSI SIM content length = %d\n",
                                        length);

                        /* Received IMSI is in the 3GPP format
                                converting it into ascii string */
                        imsi = os_zalloc(2 * length);
                        if (imsi == NULL) {
                                wpa_printf(MSG_ERROR,
                                        "eap_proxy: Couldn't allocate memmory for imsi");
                                return FALSE;
                        }
                        for (src = 1, dst = 0;
                                (src < length) && (dst < (length * 2));
                                src++) {
                                wpa_printf(MSG_ERROR,
                                        "eap_proxy: IMSI read from SIM = %d src %d\n",
                                        data[src], src);
                                if(data[src] == 0xFF) {
                                        break;
                                }
                                if (src > 1) {
                                        imsi[dst] = bin_to_hexchar(data[src] & 0x0F);
                                        dst++;
                                        wpa_printf(MSG_ERROR,
                                        "eap_proxy: IMSI dst = %d dst %d\n",
                                        imsi[dst-1], dst);
                                }
                                /* Process upper part of byte for all bytes */
                                imsi[dst] = bin_to_hexchar(data[src] >> 4);
                                dst++;
                                wpa_printf(MSG_ERROR,
                                        "eap_proxy: IMSI dst = %d dst %d\n",
                                        imsi[dst-1], dst);
                        }
                                imsi_len_g = (data[0]*2 - 1); //dst;
                                wpa_printf(MSG_ERROR,
                                        "eap_proxy: IMSI first digit = %d read length = %d"
                                        "imsi %20s\n", data[0],imsi_len_g, imsi);
                        } else{
                                wpa_printf(MSG_ERROR,
                                        "eap_proxy: IMSI read failure read_result_valid = %d\n",
                                        read_trans_resp.read_result_valid);
                                qmi_status = FALSE;
                        }
                }
        /* READ EF_AD */
        /* if qmi_status is FALSE, UIM read for mnc may not be required - To Do */
        qmi_read_trans_req.file_id.file_id = 0x6FAD;
        qmi_err_code = qmi_client_send_msg_sync(wpa_uim[sim_num].qmi_uim_svc_client_ptr,
                                        QMI_UIM_READ_TRANSPARENT_REQ_V01,
                                        (void *)&qmi_read_trans_req,
                                        sizeof(uim_read_transparent_req_msg_v01),
                                        (void *)&read_trans_resp,
                                        sizeof(uim_read_transparent_resp_msg_v01),
                                        WPA_UIM_QMI_DEFAULT_TIMEOUT);
        if (QMI_NO_ERR != qmi_err_code ||
           read_trans_resp.resp.result != QMI_RESULT_SUCCESS_V01) {
                wpa_printf(MSG_ERROR, "QMI-ERROR Unable to read MNC from UIM service;"
                           " error_ret=%d; qmi_err=%d\n", qmi_err_code,
                           read_trans_resp.resp.error);
                qmi_status = FALSE;
        }
        if (QMI_NO_ERR == qmi_err_code) {
                if (read_trans_resp.read_result_valid) {
                        length  =
                                read_trans_resp.read_result.content_len;
                        data    =
                                read_trans_resp.read_result.content;

                        if(length >= 4)
                                card_mnc_len = 0x0f & data[3];
                        if ((card_mnc_len != 2) && (card_mnc_len != 3)) {
                                if(check_for_3_digit())
                                        card_mnc_len = 3;
                                else
                                        card_mnc_len = 2;
                                wpa_printf(MSG_ERROR, "Failed to get MNC length from (U)SIM "
                                "assuming %d as mcc %s to 3 digit mnc group\n",
                                card_mnc_len, card_mnc_len == 3? "belongs":"not belongs");
                        }
                }
        }


        return qmi_status;
} /* wpa_qmi_read_card_imsi */
#endif /* SIM_AKA_IDENTITY_IMSI */

#ifdef CONFIG_EAP_PROXY_MDM_DETECT
static int eap_modem_compatible(struct dev_info *mdm_detect_info)
{
        char args[EAP_PROXY_PROPERTY_BASEBAND_SIZE] = {0};
        int ret = 0;

        /* Get the hardware property */
        ret = property_get(EAP_PROXY_PROPERTY_BASEBAND, args, "");
        if (ret > EAP_PROXY_PROPERTY_BASEBAND_SIZE){
                wpa_printf(MSG_ERROR,"eap_proxy: property [%s] has size [%d] that exceeds max [%d]",
                           EAP_PROXY_PROPERTY_BASEBAND,
                           ret,
                           EAP_PROXY_PROPERTY_BASEBAND_SIZE);
                return FALSE;
        }

        /* This will check for the type of hardware, and if the hardware type
         * needs external modem, it will check if the modem type is external */
        if(!os_strncmp(EAP_PROXY_BASEBAND_VALUE_APQ, args, 3)) {
                for (ret = 0; ret < mdm_detect_info->num_modems; ret++) {
                        if (mdm_detect_info->mdm_list[ret].type == MDM_TYPE_EXTERNAL) {
                                wpa_printf(MSG_INFO, "eap_proxy: hardware supports external modem");
                                return TRUE;
                        }
                }
                wpa_printf(MSG_ERROR, "eap_proxy: hardware does not support external modem");
                return FALSE;
        }
        return TRUE;
}
#endif /* CONFIG_EAP_PROXY_MDM_DETECT */

void wpa_qmi_register_notification(void *eloop_ctx, void *timeout_ctx)
{
        struct eap_proxy_sm *eap_proxy = eloop_ctx;
        wpa_printf(MSG_DEBUG, "eap_proxy: %s", __func__);

        eap_proxy_qmi_deinit(eap_proxy);
        eap_proxy_init(eap_proxy, NULL, NULL);
}

void wpa_qmi_handle_ssr(qmi_client_type user_handle, qmi_client_error_type error, void *err_cb_data)
{
        struct eap_proxy_sm *eap_proxy = err_cb_data;

        wpa_printf(MSG_DEBUG, "eap_proxy: %s ", __func__);

        wpa_qmi_ssr = TRUE;
        eloop_register_timeout(0, 0, wpa_qmi_register_notification, eap_proxy, NULL);
}


static void exit_proxy_init(int signum)
{
       pthread_exit(NULL);
}

static void eap_proxy_post_init(struct eap_proxy_sm *eap_proxy)
{
        int qmiErrorCode;
        int qmiRetCode;
        qmi_idl_service_object_type qmi_client_service_obj[MAX_NO_OF_SIM_SUPPORTED];
        int index;
        static Boolean flag = FALSE;
        struct sigaction    actions;
        int ret = 0;
        wpa_uim_struct_type *wpa_uim = eap_proxy->wpa_uim;
#ifdef CONFIG_EAP_PROXY_MDM_DETECT
        struct dev_info mdm_detect_info;

        /* Call ESOC API to get the number of modems.
         * If the number of modems is not zero, only then proceed
         * with the eap_proxy intialization.
         */
        ret = get_system_info(&mdm_detect_info);
        if (ret > 0)
                wpa_printf(MSG_ERROR, "eap_proxy: Failed to get system info, ret %d", ret);

        if (mdm_detect_info.num_modems == 0) {
                eap_proxy->proxy_state = EAP_PROXY_DISABLED;
                wpa_printf(MSG_ERROR, "eap_proxy: No Modem support for this target"
                           " number of modems is %d", mdm_detect_info.num_modems);
                return;
        }
        wpa_printf(MSG_DEBUG, "eap_proxy: num_modems = %d", mdm_detect_info.num_modems);

        if(eap_modem_compatible(&mdm_detect_info) == FALSE) {
                eap_proxy->proxy_state = EAP_PROXY_DISABLED;
                wpa_printf(MSG_ERROR, "eap_proxy: build does not support EAP-SIM feature");
                return;
        }
#endif /* CONFIG_EAP_PROXY_MDM_DETECT */

        sigemptyset(&actions.sa_mask);
        actions.sa_flags = 0;
        actions.sa_handler = exit_proxy_init;
        ret = sigaction(SIGUSR1,&actions,NULL);
        if(ret < 0)
                wpa_printf(MSG_DEBUG, "sigaction\n");
        eap_proxy->proxy_state = EAP_PROXY_INITIALIZE;
        eap_proxy->qmi_state = QMI_STATE_IDLE;
        eap_proxy->key = NULL;
        eap_proxy->iskey_valid = FALSE;
        eap_proxy->is_state_changed = FALSE;
        eap_proxy->isEap = FALSE;
        eap_proxy->eap_type = EAP_TYPE_NONE;
        eap_proxy->user_selected_sim = 0;

#ifdef CONFIG_EAP_PROXY_DUAL_SIM
        wpa_printf (MSG_ERROR,
                "eap_proxy: eap_proxy Initializing for DUAL SIM build %d tid %d",
                MAX_NO_OF_SIM_SUPPORTED, gettid());
#else
        wpa_printf (MSG_ERROR,
                "eap_proxy: eap_proxy Initializing for Single SIM build %d tid %d",
                MAX_NO_OF_SIM_SUPPORTED, gettid());
#endif


        for (index = 0; index < MAX_NO_OF_SIM_SUPPORTED; ++index) {

#ifdef SIM_AKA_IDENTITY_IMSI
                if (FALSE == eap_proxy->qmi_uim_svc_client_initialized[index])  {
                        qmi_client_os_params eap_os_params;
                        /* Init QMI_UIM service for EAP-SIM/AKA */
                        os_memset(&eap_os_params, 0, sizeof(qmi_client_os_params));

                        qmiErrorCode = qmi_client_init_instance(
                                        uim_get_service_object_v01(),
                                        QMI_CLIENT_INSTANCE_ANY,
                                        wpa_qmi_client_indication_cb,
                                        eap_proxy, &eap_os_params,
                                        10000,
                                        &wpa_uim[index].qmi_uim_svc_client_ptr);

                        if ((wpa_uim[index].qmi_uim_svc_client_ptr == NULL) || (qmiErrorCode > 0)) {
                                wpa_printf(MSG_ERROR, "eap_proxy: Could not register with QMI UIM"
                                        "Service, qmi_uim_svc_client_ptr: %p,qmi_err_code: %d\n",
                                        wpa_uim[index].qmi_uim_svc_client_ptr, qmiErrorCode);
                                wpa_uim[index].qmi_uim_svc_client_ptr = NULL;
                                flag = FALSE;
                                continue;
                        }
                        eap_proxy->qmi_uim_svc_client_initialized[index] = TRUE;

                        wpa_printf (MSG_ERROR, "eap_proxy: QMI uim service client initialized with"
                                "success tid is %d %p %d\n",
                                gettid(), wpa_uim[index].qmi_uim_svc_client_ptr, qmiErrorCode);
                        /* Register the card events with the QMI / UIM */
                        wpa_qmi_register_events(index, wpa_uim);
                        qmiErrorCode = qmi_client_register_error_cb(
                                wpa_uim[index].qmi_uim_svc_client_ptr, wpa_qmi_handle_ssr, eap_proxy);
                        wpa_printf(MSG_DEBUG,
                                "eap_proxy: qmi_client_register_error_cb() status %d\n", qmiErrorCode);
                        wpa_qmi_ssr = FALSE;
                } else
                        wpa_printf (MSG_ERROR, "eap_proxy: QMI uim service client is already init"
                                "ialized tid is %d \n", gettid());


                qmi_client_os_params eap_os_params;
                os_memset(&eap_os_params, 0, sizeof(qmi_client_os_params));

                qmiErrorCode = qmi_client_init_instance(auth_get_service_object_v01(),
                                                        QMI_CLIENT_INSTANCE_ANY,
                                                        handle_qmi_eap_ind,
                                                        eap_proxy,
                                                        &eap_os_params,
                                                        10000,
                                                        &eap_proxy->qmi_auth_svc_client_ptr[index]);


                if ((eap_proxy->qmi_auth_svc_client_ptr[index] == NULL) || (qmiErrorCode > 0)) {
                        wpa_printf(MSG_ERROR, "eap_proxy: Could not register with QMI auth Service "
                                        "qmi_auth_svc_client_ptr: %p,qmi_err_code: %d\n",
                                        eap_proxy->qmi_auth_svc_client_ptr[index], qmiErrorCode);
                        eap_proxy->qmi_auth_svc_client_ptr[index] = NULL;
                        flag = FALSE;
                        continue;
                }
                wpa_printf (MSG_ERROR, "eap_proxy: QMI auth service client initialized with success"
                        " tid is %d  %p eapol_proxy=%p\n", gettid(),
                                eap_proxy->qmi_auth_svc_client_ptr[index], eap_proxy);
                flag = TRUE;
                /* Register for the notifications from QMI / AUTH */
                wpa_qmi_register_auth_inds(eap_proxy);
#endif /* SIM_AKA_IDENTITY_IMSI */
        }

        if ( flag == FALSE ) {
                eap_proxy->proxy_state = EAP_PROXY_DISABLED;
                wpa_printf(MSG_ERROR, "eap_proxy: flag = %d proxy init failed\n", flag);
                return;
        }

        eap_proxy->proxy_state = EAP_PROXY_IDLE;
        eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapSuccess, FALSE);
        eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapFail, FALSE);
        eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapRestart, FALSE);
        eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapResp, FALSE);
        eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapNoResp, FALSE);
        wpa_printf (MSG_ERROR, "eap_proxy: Eap_proxy initialized successfully"
                " tid is %d \n", gettid());
        return;

}

int eap_auth_end_eap_session(qmi_client_type qmi_auth_svc_client_ptr)
{
        qmi_client_error_type qmiRetCode = 0;
        auth_end_eap_session_resp_msg_v01 end_eap_session_resp_msg ;

        wpa_printf(MSG_ERROR, "eap_proxy: eap_auth_end_eap_session: Ending EAP auth session");


        /* Send QMI_AUTH_END_EAP_SESSION_REQ */

        os_memset(&end_eap_session_resp_msg,
                        0,
                        sizeof(auth_end_eap_session_resp_msg_v01));

        qmiRetCode = qmi_client_send_msg_sync(qmi_auth_svc_client_ptr,
                                              QMI_AUTH_END_EAP_SESSION_REQ_V01,
                                              NULL,
                                              0,
                                              (void *) &end_eap_session_resp_msg,
                                              sizeof(auth_end_eap_session_resp_msg_v01),
                                              WPA_UIM_QMI_DEFAULT_TIMEOUT);

        if (QMI_NO_ERR != qmiRetCode ||
            end_eap_session_resp_msg.resp.result != QMI_RESULT_SUCCESS_V01) {
                wpa_printf(MSG_ERROR, "QMI-ERROR Unable to End the EAP session;"
                                " error_ret=%d; qmi_err=%d\n", qmiRetCode,
                                end_eap_session_resp_msg.resp.error);
                return -1;
        }

        wpa_printf(MSG_ERROR, "eap_proxy: eap_auth_end_eap_session:"
                " EAP auth session ended successfuly");

        return 0;
}

static void eap_proxy_schedule_thread(void *eloop_ctx, void *timeout_ctx)
{
        struct eap_proxy_sm *eap_proxy = eloop_ctx;
        pthread_attr_t attr;
        int ret = -1;

        pthread_attr_init(&attr);
        pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
        ret = pthread_create(&eap_proxy->thread_id, &attr, eap_proxy_post_init, eap_proxy);
        if(ret < 0)
               wpa_printf(MSG_ERROR, "eap_proxy: starting thread is failed %d\n", ret);
}

struct eap_proxy_sm *
eap_proxy_init(void *eapol_ctx, const struct eapol_callbacks *eapol_cb,
               void *msg_ctx)
{
        int qmiErrorCode;
        int qmiRetCode;
        struct eap_proxy_sm *eap_proxy;
        qmi_idl_service_object_type    qmi_client_service_obj;

        wpa_printf(MSG_DEBUG, "eap_proxy: %s  "
                 "wpa_qmi_ssr %d", __func__, wpa_qmi_ssr);
        if(wpa_qmi_ssr) {
                eap_proxy = eapol_ctx;
        } else {
                eap_proxy =  os_malloc(sizeof(struct eap_proxy_sm));
                if (NULL == eap_proxy) {
                        wpa_printf(MSG_ERROR, "Error memory alloc  for eap_proxy"
                                "eap_proxy_init\n");
                        return NULL;
                }
                os_memset(eap_proxy, 0, sizeof(*eap_proxy));
                eap_proxy->ctx = eapol_ctx;
                eap_proxy->eapol_cb = eapol_cb;
                eap_proxy->msg_ctx = msg_ctx;
        }

        eap_proxy->proxy_state = EAP_PROXY_DISABLED;
        eap_proxy->qmi_state = QMI_STATE_IDLE;
        eap_proxy->key = NULL;
        eap_proxy->iskey_valid = FALSE;
        eap_proxy->is_state_changed = FALSE;
        eap_proxy->isEap = FALSE;
        eap_proxy->eap_type = EAP_TYPE_NONE;

        /* delay the qmi client initialization after the eloop_run starts,
        * in order to avoid the case of daemonize enabled, which exits the
        * parent process that created the qmi client context.
        */

        eloop_register_timeout(0, 0, eap_proxy_schedule_thread, eap_proxy, NULL);
        return eap_proxy;
}


static void eap_proxy_qmi_deinit(struct eap_proxy_sm *eap_proxy)
{
        int qmiRetCode;
        int qmiErrorCode;
        int index;
        wpa_uim_struct_type *wpa_uim = eap_proxy->wpa_uim;

        if (NULL == eap_proxy)
                return;

        pthread_kill(eap_proxy->thread_id, SIGUSR1);
        eap_proxy->proxy_state = EAP_PROXY_DISABLED;

        for (index = 0; index < MAX_NO_OF_SIM_SUPPORTED; ++index) {
                if (TRUE == eap_proxy->eap_auth_session_flag[index]) {

                        /* end the current EAP session */
                        if(eap_auth_end_eap_session(eap_proxy->qmi_auth_svc_client_ptr[index]) < 0 ){
                                wpa_printf(MSG_ERROR, "eap_proxy: Unable to end the EAP session for"
                                                " client %d", index+1);
                        } else {
                                wpa_printf(MSG_ERROR, "eap_proxy: Ended the QMI EAP session for "
                                                "client %d\n",
                                                index+1);
                                eap_proxy->eap_auth_session_flag[index] = FALSE;
                        }
                } else {
                        wpa_printf (MSG_ERROR, "eap_proxy: session not started"
                                " for client = %d\n", index+1);
                        continue;
                }

                if ((TRUE == eap_proxy->qmi_uim_svc_client_initialized[index]))  {
                        qmiRetCode = qmi_client_release(wpa_uim[index].qmi_uim_svc_client_ptr);
                        if (QMI_NO_ERR != qmiRetCode) {
                                wpa_printf (MSG_ERROR, "eap_proxy: Unable to Releas the connection"
                                                " to uim service for client=%d; error_ret=%d\n;",
                                                index+1, qmiRetCode);
                        }
                        wpa_printf(MSG_ERROR, "eap_proxy: Released QMI UIM service client\n");
                        eap_proxy->qmi_uim_svc_client_initialized[index] = FALSE;
                }

                qmiRetCode = qmi_client_release(eap_proxy->qmi_auth_svc_client_ptr[index]);
                if (QMI_NO_ERR != qmiRetCode) {
                        wpa_printf (MSG_ERROR, "eap_proxy: Unable to Releas the connection"
                                        " to auth service for client=%d; error_ret=%d\n;",
                                        index+1, qmiRetCode);
                }  else {
                        wpa_printf(MSG_ERROR, "eap_proxy: Released QMI EAP service client\n");
                }

        }

        if (NULL != eap_proxy->key) {
                os_free(eap_proxy->key);
                eap_proxy->key = NULL;
        }

        eap_proxy->iskey_valid = FALSE;
        eap_proxy->is_state_changed = FALSE;
        eap_proxy->user_selected_sim = 0;

}

void eap_proxy_deinit(struct eap_proxy_sm *eap_proxy)
{
        eap_proxy_qmi_deinit(eap_proxy);
        if (eap_proxy != NULL) {
            os_free(eap_proxy);
            eap_proxy = NULL;
            wpa_printf(MSG_INFO, "eap_proxy: eap_proxy Deinitialzed\n");
        }
}

/* Call-back function to process an authentication result indication
*  from QMI EAP service */
static void handle_qmi_eap_ind(qmi_client_type user_handle,
                               unsigned int msg_id,
                               void* ind_buf,
                               unsigned int ind_buf_len,
                               void* ind_cb_data)
{
        qmi_client_error_type qmi_err;
        auth_eap_session_result_ind_msg_v01 eap_session_result;
        memset(&eap_session_result, 0, sizeof(auth_eap_session_result_ind_msg_v01));
        eap_session_result.eap_result = -1;
        struct eap_proxy_sm *sm = (struct eap_proxy_sm *)ind_cb_data;

        auth_eap_notification_code_ind_msg_v01 eap_notification;
        memset(&eap_notification, 0, sizeof(auth_eap_notification_code_ind_msg_v01));

        wpa_printf(MSG_ERROR, "eap_proxy: Handle_qmi_eap_ind msgId =%d  sm=%p\n", msg_id,sm);
        /* Decode */

        switch(msg_id)
        {
                case QMI_AUTH_EAP_SESSION_RESULT_IND_V01:

                        qmi_err = qmi_client_message_decode(user_handle, QMI_IDL_INDICATION,
                                        msg_id, (void*)ind_buf, ind_buf_len,
                                        &eap_session_result,
                                        sizeof(auth_eap_session_result_ind_msg_v01));
                        if (qmi_err != QMI_NO_ERR)
                        {
                                wpa_printf(MSG_ERROR, "eap_proxy: Error in qmi_client_message_de"
                                        "code; error_code=%d \n", qmi_err);
                                sm->srvc_result = EAP_PROXY_QMI_SRVC_FAILURE;
                                return;
                        }
                        if ((eap_session_result.eap_result == 0) &&
                            (QMI_STATE_RESP_TIME_OUT != sm->qmi_state)) {
                                sm->proxy_state = EAP_PROXY_AUTH_SUCCESS;
                                sm->qmi_state = QMI_STATE_RESP_RECEIVED;
                                wpa_printf(MSG_ERROR, "eap_proxy: Handle_qmi_eap_ind EAP PROXY AUTH"
                                        " SUCCESS %p set to %d\n",
                                        (void *)&sm->qmi_state, sm->qmi_state);
                        } else {
                                sm->proxy_state = EAP_PROXY_AUTH_FAILURE;
                                wpa_printf(MSG_ERROR, "eap_proxy: Handle_qmi_eap_ind EAP PROXY AUTH"
                                        " FAILURE \n");
                        }
                        sm->srvc_result = EAP_PROXY_QMI_SRVC_SUCCESS;
                        break;

                case QMI_AUTH_EAP_NOTIFICATION_CODE_IND_V01:

                        qmi_err = qmi_client_message_decode(user_handle, QMI_IDL_INDICATION,
                                        msg_id, (void*)ind_buf, ind_buf_len,
                                        &eap_notification,
                                        sizeof(auth_eap_notification_code_ind_msg_v01));
                        if (qmi_err != QMI_NO_ERR)
                        {
                                wpa_printf(MSG_ERROR, "eap_proxy: Error in qmi_client_"
                                        "message_decode; error_code=%d \n", qmi_err);
                        }
                        sm->notification_code = eap_notification.eap_notification_code;
                        wpa_printf(MSG_ERROR, "eap_proxy: notificatio code is %x\n",
                                        eap_notification.eap_notification_code);
                        break;

                default:
                        wpa_printf(MSG_ERROR, "eap_proxy: An unexpected msg Id=%d"
                                        " is given\n", msg_id);
                        break;
        }


}


/* Call-back function to process an EAP response from QMI EAP service */
static void handle_qmi_eap_reply(
                qmi_client_type userHandle, unsigned int msg_id,
                void *resp_c_struct, unsigned int resp_c_struct_len,
                void *userData, qmi_client_error_type sysErrCode)
{
        struct eap_proxy_sm *eap_proxy = (struct eap_proxy_sm *)userData;
        auth_send_eap_packet_resp_msg_v01* rspData =
                (auth_send_eap_packet_resp_msg_v01*)resp_c_struct;

        u8 *resp_data;
        u32 length;

        wpa_printf(MSG_ERROR, "eap_proxy: %s started\n", __func__);
        if (eap_proxy == NULL) {
                wpa_printf(MSG_ERROR, "eap_proxy: eap_proxy is NULL");
                return;
        }
        if (QMI_STATE_RESP_PENDING == eap_proxy->qmi_state) {

                wpa_printf(MSG_ERROR, "eap_proxy: user_selected_sim = %d\n",
                           eap_proxy->user_selected_sim+1);


                if (QMI_NO_ERR != sysErrCode) {
                        wpa_printf(MSG_ERROR, "eap_proxy: An error is encountered with"
                                        " the request: sysErrorCode=%d\n",
                                        sysErrCode);
                        eap_proxy->qmi_state = QMI_STATE_RESP_TIME_OUT;
                        return;
                }

                if (NULL == rspData) {
                        wpa_printf(MSG_ERROR, "eap_proxy: Response data is NULL\n");
                        eap_proxy->qmi_state = QMI_STATE_RESP_TIME_OUT;
                        return;
                }
                if((QMI_AUTH_SEND_EAP_PACKET_REQ_V01 != msg_id) &&
                   (QMI_AUTH_SEND_EAP_PACKET_EXT_REQ_V01 != msg_id))
                {
                        wpa_printf(MSG_ERROR, "eap_proxy: Invalid msgId =%d\n", msg_id);
                        eap_proxy->qmi_state = QMI_STATE_RESP_TIME_OUT;
                        return;
                }

                /* ensure the reply packet exists  */
                if (rspData->eap_response_pkt_len <= 0 ||
                    rspData->eap_response_pkt_len > QMI_AUTH_EAP_RESP_PACKET_EXT_MAX_V01) {
                        wpa_printf(MSG_ERROR, "eap_proxy: Reply packet is of invalid length %d"
                                " error %d result %d\n", rspData->eap_response_pkt_len,
                                rspData->resp.error, rspData->resp.result);
                        eap_proxy->qmi_state = QMI_STATE_RESP_TIME_OUT;
                        return;
                }

                length = rspData->eap_response_pkt_len;
                eap_proxy->qmi_resp_data.eap_send_pkt_resp.length = length;
                /* allocate a buffer to store the response data; size is EAP resp len field */
                eap_proxy->qmi_resp_data.eap_send_pkt_resp.resp_data =
                        os_malloc(rspData->eap_response_pkt_len);

                resp_data =
                        (u8 *)eap_proxy->qmi_resp_data.eap_send_pkt_resp.resp_data;

                if (NULL == resp_data) {
                        wpa_printf(MSG_ERROR, "eap_proxy: Unable to allocate memory for"
                                        " reply packet\n");
                        eap_proxy->qmi_state = QMI_STATE_RESP_TIME_OUT;

                        return;
                }

                /* copy the response data to the allocated buffer */
                os_memcpy(resp_data,
                                rspData->eap_response_pkt, length);
                eap_proxy->qmi_state = QMI_STATE_RESP_RECEIVED;
                wpa_printf(MSG_ERROR, "eap_proxy: **HANDLE_QMI_EAP_REPLY CALLBACK ENDDED **");

                wpa_printf(MSG_ERROR, "eap_proxy: Dump Resp Data len %d\n", length);
                dump_buff(resp_data, length);
        }

        return;
}

static enum eap_proxy_status eap_proxy_process(struct eap_proxy_sm  *eap_proxy,
                                        u8 *eapReqData, int eapReqDataLen, struct eap_sm *eap_sm)
{
        struct eap_hdr *hdr;
        int qmiErrorCode;
        enum eap_proxy_status proxy_status = EAP_PROXY_SUCCESS;
        auth_send_eap_packet_req_msg_v01 eap_send_packet_req;
        auth_send_eap_packet_resp_msg_v01 eap_send_packet_resp;
        qmi_txn_handle async_txn_hdl = 0;

        auth_send_eap_packet_ext_req_msg_v01 eap_send_packet_ext_req;
        auth_send_eap_packet_ext_resp_msg_v01 eap_send_packet_ext_resp;


        hdr = (struct eap_hdr *)eapReqData;
        if ((EAP_CODE_REQUEST == hdr->code) &&
            (EAP_TYPE_IDENTITY == eapReqData[4])) {
                if (eap_proxy_eapol_sm_get_bool(eap_proxy, EAPOL_eapRestart) &&
                    eap_proxy_eapol_sm_get_bool(eap_proxy, EAPOL_portEnabled)) {
                        wpa_printf (MSG_ERROR, "eap_proxy: Already Authenticated."
                                    " Clear all the flags");
                        eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapSuccess, FALSE);
                        eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapFail, FALSE);
                        eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapResp, FALSE);
                        eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapNoResp, FALSE);
                        if (eap_proxy->key) {
                                os_free(eap_proxy->key);
                                eap_proxy->key = NULL;
                        }
                        eap_proxy->iskey_valid = FALSE;
                        eap_proxy->is_state_changed = TRUE;
                }
                eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapRestart, FALSE);

                if(eap_proxy_build_identity(eap_proxy, hdr->identifier, eap_sm)) {
                        eap_proxy->proxy_state = EAP_PROXY_IDENTITY;
                } else {
                        wpa_printf(MSG_ERROR, "eap_proxy: Error in build identity\n");
                        return EAP_PROXY_FAILURE;
                }
        }
        wpa_printf(MSG_ERROR, "eap_proxy: ***********Dump ReqData len %d***********",
                eapReqDataLen);
        dump_buff(eapReqData, eapReqDataLen);
        if (eapReqDataLen <= QMI_AUTH_EAP_REQ_PACKET_MAX_V01) {
                os_memset(&eap_send_packet_req, 0, sizeof(auth_send_eap_packet_req_msg_v01));
                os_memset(&eap_send_packet_resp, 0, sizeof(auth_send_eap_packet_resp_msg_v01));
                eap_send_packet_req.eap_request_pkt_len = eapReqDataLen ;
                memcpy(eap_send_packet_req.eap_request_pkt, eapReqData, eapReqDataLen);
        } else if (eapReqDataLen <= QMI_AUTH_EAP_REQ_PACKET_EXT_MAX_V01) {
                os_memset(&eap_send_packet_ext_req, 0,
                        sizeof(auth_send_eap_packet_ext_req_msg_v01));
                os_memset(&eap_send_packet_ext_resp, 0,
                        sizeof(auth_send_eap_packet_ext_resp_msg_v01));
                eap_send_packet_ext_req.eap_request_ext_pkt_len = eapReqDataLen;
                memcpy(eap_send_packet_ext_req.eap_request_ext_pkt, eapReqData, eapReqDataLen);
        } else {
                        wpa_printf(MSG_ERROR, "eap_proxy: Error in eap_send_packet_req\n");
                        return EAP_PROXY_FAILURE;
        }

        wpa_printf(MSG_ERROR, "eap_proxy: SIM selected by User: Selected sim = %d\n",
                eap_proxy->user_selected_sim+1);
        if (eap_proxy->qmi_state != QMI_STATE_IDLE) {
                wpa_printf(MSG_ERROR, "Error in QMI state=%d\n",
                                         eap_proxy->qmi_state);
                return EAP_PROXY_FAILURE;
        }

        wpa_printf (MSG_ERROR, "eap_proxy: In eap_proxy_process case %d\n", hdr->code);
        eap_proxy->qmi_state = QMI_STATE_RESP_PENDING;

        if(eapReqDataLen <= QMI_AUTH_EAP_REQ_PACKET_MAX_V01) {
                qmiErrorCode = qmi_client_send_msg_async(
                                eap_proxy->qmi_auth_svc_client_ptr[eap_proxy->user_selected_sim],
                                QMI_AUTH_SEND_EAP_PACKET_REQ_V01,
                                (void *) &eap_send_packet_req,
                                sizeof(auth_send_eap_packet_req_msg_v01),
                                (void *) &eap_send_packet_resp,
                                sizeof(auth_send_eap_packet_resp_msg_v01),
                                &handle_qmi_eap_reply, eap_proxy,
                                &async_txn_hdl);
        } else if(eapReqDataLen <= QMI_AUTH_EAP_REQ_PACKET_EXT_MAX_V01) {
                qmiErrorCode = qmi_client_send_msg_async(
                                eap_proxy->qmi_auth_svc_client_ptr[eap_proxy->user_selected_sim],
                                QMI_AUTH_SEND_EAP_PACKET_EXT_REQ_V01,
                                (void *) &eap_send_packet_ext_req,
                                sizeof(auth_send_eap_packet_ext_req_msg_v01),
                                (void *) &eap_send_packet_ext_resp,
                                sizeof(auth_send_eap_packet_ext_resp_msg_v01),
                                &handle_qmi_eap_reply, eap_proxy,
                                &async_txn_hdl);
        }

        if (QMI_NO_ERR != qmiErrorCode) {
                wpa_printf(MSG_ERROR, "QMI-ERROR Error in sending EAP packet;"
                                " error_code=%d\n", qmiErrorCode);
                eap_proxy->proxy_state = EAP_PROXY_DISCARD;
                eap_proxy_eapol_sm_set_bool(eap_proxy, EAPOL_eapNoResp, TRUE);
                eap_proxy->qmi_state = QMI_STATE_RESP_PENDING;
                return EAP_PROXY_FAILURE;
        } else {
                wpa_printf (MSG_ERROR, "eap_proxy: In eap_proxy_process case %d\n", hdr->code);
                switch (hdr->code) {
                case EAP_CODE_SUCCESS:
                        if (EAP_PROXY_SUCCESS !=
                                eap_proxy_qmi_response_wait(eap_proxy)) {
                                eap_proxy->proxy_state = EAP_PROXY_DISCARD;
                                eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                        EAPOL_eapNoResp, TRUE);
                                return EAP_PROXY_FAILURE;
                        } else if( eap_proxy->proxy_state == EAP_PROXY_AUTH_SUCCESS ) {
                                eap_proxy_getKey(eap_proxy);
                                eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                 EAPOL_eapSuccess, TRUE);
        /*
         * RFC 4137 does not clear eapReq here, but this seems to be required
         * to avoid processing the same request twice when state machine is
         * initialized.
         */
                        eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                        EAPOL_eapReq, FALSE);

        /*
         * RFC 4137 does not set eapNoResp here, but this seems to be required
         * to get EAPOL Supplicant backend state machine into SUCCESS state. In
         * addition, either eapResp or eapNoResp is required to be set after
         * processing the received EAP frame.
         */
                        eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                EAPOL_eapNoResp, TRUE);

                        wpa_msg(eap_proxy->msg_ctx, MSG_INFO, WPA_EVENT_EAP_SUCCESS
                                "eap_proxy: EAP authentication completed successfully");

                        eap_proxy->is_state_changed = TRUE;

                                /* Retrieve the keys  and store*/
                        } else if( eap_proxy->proxy_state == EAP_PROXY_AUTH_FAILURE ){

                                eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                EAPOL_eapFail, TRUE);
                                eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                EAPOL_eapReq, FALSE);
                                eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                EAPOL_eapNoResp, TRUE);
                                eap_proxy->is_state_changed = TRUE;

                        }

                        break;

                case EAP_CODE_FAILURE:
                        wpa_printf (MSG_ERROR,
                                "eap_proxy: in eap_proxy_process case EAP_CODE_FAILURE\n");
                        eap_proxy->proxy_state = EAP_PROXY_AUTH_FAILURE;
                        eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                EAPOL_eapFail, TRUE);

        /*
         * RFC 4137 does not clear eapReq here, but this seems to be required
         * to avoid processing the same request twice when state machine is
         * initialized.
        */
                        eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                EAPOL_eapReq, FALSE);

        /*
         * RFC 4137 does not set eapNoResp here. However, either eapResp or
         * eapNoResp is required to be set after processing the received EAP
         * frame.
         */
                        eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                EAPOL_eapNoResp, TRUE);

                        wpa_msg(eap_proxy->msg_ctx, MSG_INFO, WPA_EVENT_EAP_FAILURE
                                "EAP authentication failed notification code 0x%x",
                                eap_proxy->notification_code);

                        eap_proxy->is_state_changed = TRUE;
                        break;

                case EAP_CODE_REQUEST:
                                        eap_proxy->proxy_state = EAP_PROXY_SEND_RESPONSE;
                        if (EAP_PROXY_SUCCESS !=
                                eap_proxy_qmi_response_wait(eap_proxy)) {
                                eap_proxy->proxy_state = EAP_PROXY_DISCARD;
                                eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                        EAPOL_eapNoResp, TRUE);
                                return EAP_PROXY_FAILURE;
                        } else {
                                eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                        EAPOL_eapResp, TRUE);
                                eap_proxy->proxy_state =
                                                EAP_PROXY_SEND_RESPONSE;
                        }

                        eap_proxy_eapol_sm_set_bool(eap_proxy,
                                                EAPOL_eapReq, FALSE);
                        eap_proxy->is_state_changed = TRUE;
                        break;

                default:
                        wpa_printf(MSG_ERROR, "eap_proxy: Error in sending EAP packet;"
                                         " error_code=%d\n", qmiErrorCode);
                        eap_proxy->proxy_state = EAP_PROXY_DISCARD;
                        eap_proxy_eapol_sm_set_bool(eap_proxy,
                                EAPOL_eapNoResp, TRUE);
                        return EAP_PROXY_FAILURE;
                }
        }

        return EAP_PROXY_SUCCESS;
}


static u8 *eap_proxy_getKey(struct eap_proxy_sm *eap_proxy)
{
        int qmiErrorCode;
        int qmiRetCode;

        auth_get_eap_session_keys_resp_msg_v01 key_resp_msg;
        os_memset(&key_resp_msg, 0, sizeof(auth_get_eap_session_keys_resp_msg_v01));

        qmiRetCode = qmi_client_send_msg_sync(
                        eap_proxy->qmi_auth_svc_client_ptr[eap_proxy->user_selected_sim],
                        QMI_AUTH_GET_EAP_SESSION_KEYS_REQ_V01,
                        NULL,
                        0,
                        (void *) &key_resp_msg,
                        sizeof(auth_get_eap_session_keys_resp_msg_v01),
                        WPA_UIM_QMI_DEFAULT_TIMEOUT);


        /* see if the MSK is acquired successfully */
        if (QMI_NO_ERR != qmiRetCode || key_resp_msg.resp.result != QMI_RESULT_SUCCESS_V01) {
                wpa_printf(MSG_ERROR, "QMI-ERROR Unable to get session keys;"
                                 " err_code=%d qmiErr=%d\n", qmiRetCode, key_resp_msg.resp.error);
                eap_proxy->key = NULL;
                return NULL;
        }
        wpa_printf(MSG_ERROR, "eap_proxy: %s:session_key_len =%d", __func__,
                key_resp_msg.session_key_len);

        if(key_resp_msg.session_key_len <=0 ||
           key_resp_msg.session_key_len > EAP_PROXY_KEYING_DATA_LEN)
        {
                return NULL;

        }
        eap_proxy->key = os_malloc(EAP_PROXY_KEYING_DATA_LEN);
        if(eap_proxy->key == NULL)
                return NULL;

        memset(eap_proxy->key, 0, EAP_PROXY_KEYING_DATA_LEN);
        memcpy(eap_proxy->key, key_resp_msg.session_key, key_resp_msg.session_key_len);

        eap_proxy->iskey_valid = TRUE;
        eap_proxy->proxy_state = EAP_PROXY_AUTH_SUCCESS;

        wpa_printf(MSG_ERROR, "eap_proxy: eap_proxy_getkey EAP KEYS ");
        dump_buff(eap_proxy->key, EAP_PROXY_KEYING_DATA_LEN);
        return eap_proxy->key;
}


/**
 * eap_key_available - Get key availability (eapKeyAvailable variable)
 * @sm: Pointer to EAP state machine allocated with eap_sm_init()
 * Returns: 1 if EAP keying material is available, 0 if not
 */
int eap_proxy_key_available(struct eap_proxy_sm *sm)
{
        return sm ? sm->iskey_valid : 0;
}


static int eap_proxy_is_state_changed(struct eap_proxy_sm *sm)
{
        if (NULL == sm)
                return 0;

        if (TRUE == sm->is_state_changed) {
                sm->is_state_changed = FALSE;
                return 1;
        } else {
                return 0;
        }
}


/**
 * eap_get_eapKeyData - Get master session key (MSK) from EAP state machine
 * @sm: Pointer to EAP state machine allocated with eap_sm_init()
 * @len: Pointer to variable that will be set to number of bytes in the key
 * Returns: Pointer to the EAP keying data or %NULL on failure
 *
 * Fetch EAP keying material (MSK, eapKeyData) from the EAP state machine. The
 * key is available only after a successful authentication. EAP state machine
 * continues to manage the key data and the caller must not change or free the
 * returned data.
 */
const u8 * eap_proxy_get_eapKeyData(struct eap_proxy_sm *sm, size_t *len)
{
        if (sm == NULL || sm->key == NULL) {
                *len = 0;
                return NULL;
        }

        *len = EAP_PROXY_KEYING_DATA_LEN;
        return sm->key;
}

/**
 * eap_proxy_get_eapRespData - Get EAP response data
 * @sm: Pointer to EAP state machine allocated with eap_sm_init()
 * @len: Pointer to variable that will be set to the length of the response
 * Returns: Pointer to the EAP response (eapRespData) or %NULL on failure
 *
 * Fetch EAP response (eapRespData) from the EAP state machine. This data is
 * available when EAP state machine has processed an incoming EAP request. The
 * EAP state machine does not maintain a reference to the response after this
 * function is called and the caller is responsible for freeing the data.
 */
struct wpabuf * eap_proxy_get_eapRespData(struct eap_proxy_sm *eap_proxy)
{
        struct wpabuf *resp;
        int len;
        //int i;

        wpa_printf(MSG_ERROR, "eap_proxy: eap_proxy_get_eapRespData");
        if ( (eap_proxy == NULL) ||
             (eap_proxy->qmi_resp_data.eap_send_pkt_resp.resp_data == NULL)
           )
        {
                return NULL;
        }

        len = eap_proxy->qmi_resp_data.eap_send_pkt_resp.length;
        wpa_printf(MSG_ERROR, "eap_proxy: eap_proxy_get_eapRespData len = %d", len);
        resp = wpabuf_alloc(len);
        if (resp == NULL) {
                wpa_printf(MSG_ERROR, "eap_proxy: buf allocation failed\n");
                return NULL;
        }

        resp->used = len;
        os_memcpy(resp->buf, eap_proxy->qmi_resp_data.eap_send_pkt_resp.resp_data,
                   len);
        /*
        for (i = 0; i < len; i++) {
                wpa_printf (MSG_ERROR, "%c", resp->buf[i]);
        }
        */
        os_free(eap_proxy->qmi_resp_data.eap_send_pkt_resp.resp_data);
        eap_proxy->qmi_resp_data.eap_send_pkt_resp.resp_data = NULL;
        eap_proxy->qmi_resp_data.eap_send_pkt_resp.length = 0;

        return resp;
}


static enum eap_proxy_status eap_proxy_qmi_response_wait(struct eap_proxy_sm *eap_proxy)
{

        int count = 0;

        wpa_printf(MSG_DEBUG, "eap_proxy_qmi_response_wait: Start blocking "
                   "wait eap_proxy=%p",eap_proxy);
        do {
                count++;
                if (count > QMI_RESP_TIME_OUT / 2) {
                        wpa_printf(MSG_ERROR,
                                   "eap_proxy: eap_proxy_qmi_response_wait "
                                   "!QMI STATE %d TIME_OUT\n",
                                   eap_proxy->qmi_state);
                        eap_proxy->qmi_state = QMI_STATE_RESP_TIME_OUT;
                        break;
                }

                os_sleep(0, 2000);

                if ((QMI_STATE_RESP_RECEIVED == eap_proxy->qmi_state) ||
                   (QMI_STATE_RESP_TIME_OUT == eap_proxy->qmi_state))
                        break;
        } while (1);

        wpa_printf(MSG_DEBUG, "eap_proxy: eap_proxy_qmi_response_wait: Wait done after %d "
                   "iterations: qmi_state=%d", count,
                   eap_proxy->qmi_state);

        if (QMI_STATE_RESP_TIME_OUT == eap_proxy->qmi_state) {
                wpa_printf(MSG_ERROR, "eap_proxy: QMI state Response Time out\n");
                eap_proxy->proxy_state = EAP_PROXY_DISCARD;
                return EAP_PROXY_FAILURE;
        }
        eap_proxy->qmi_state = QMI_STATE_IDLE;

        return EAP_PROXY_SUCCESS;
}


static void eap_proxy_eapol_sm_set_bool(struct eap_proxy_sm *sm,
                        enum eapol_bool_var var, Boolean value)
{
        sm->eapol_cb->set_bool(sm->ctx, var, value);
}


static Boolean eap_proxy_eapol_sm_get_bool(struct eap_proxy_sm *sm,
                         enum eapol_bool_var var)
{
        return  sm->eapol_cb->get_bool(sm->ctx, var);
}


int eap_proxy_sm_step(struct eap_proxy_sm *sm, struct eap_sm *eap_sm)
{
        if ((sm->proxy_state != EAP_PROXY_INITIALIZE) &&
                                 (sm->proxy_state != EAP_PROXY_DISABLED)) {
                if (TRUE == sm->isEap) {
                        if(!eap_proxy_process(sm, sm->eapReqData,
                                                 sm->eapReqDataLen,eap_sm)) {
                                sm->proxy_state = EAP_PROXY_AUTH_FAILURE;
                                eap_proxy_eapol_sm_set_bool(sm, EAPOL_eapRestart, TRUE);
                        }
                        sm->isEap = FALSE;
                }
        }
        return eap_proxy_is_state_changed(sm);
}


enum eap_proxy_status
eap_proxy_packet_update(struct eap_proxy_sm *eap_proxy, u8 *eapReqData,
                        int eapReqDataLen)
{
        eap_proxy->eapReqData = eapReqData;
        eap_proxy->eapReqDataLen = eapReqDataLen;
        eap_proxy->isEap = TRUE;
        return EAP_PROXY_SUCCESS;
}


u8 * eap_proxy_get_eap_session_id(struct eap_proxy_sm *sm, size_t *len)
{
        wpa_printf(MSG_ERROR, "%s: enter: not implemented\n", __func__);
        return NULL;
}


u8 * eap_proxy_get_emsk(struct eap_proxy_sm *sm, size_t *len)
{
        wpa_printf(MSG_ERROR, "%s: enter: not implemented\n", __func__);
        return NULL;
}


void eap_proxy_sm_abort(struct eap_proxy_sm *sm)
{
        wpa_printf(MSG_ERROR, "%s: enter: not implemented\n", __func__);
        return;
}


static void dump_buff(u8 *buff, int len)
{
        int i ;

        wpa_printf(MSG_ERROR, "eap_proxy: ---- EAP Buffer----LEN %d\n",len);
        for (i = 0; i < len; i++) {
                if (0 == i%8)
                        wpa_printf(MSG_DEBUG, " \n");
                wpa_printf(MSG_ERROR, "eap_proxy: 0x%x  ", buff[i]);
        }
        return;
}
static char bin_to_hexchar(u8 ch)
{
        if (ch < 0x0a) {
                return ch + '0';
        }
        return ch + 'a' - 10;
}
static Boolean eap_proxy_build_identity(struct eap_proxy_sm *eap_proxy, u8 id, struct eap_sm *eap_sm)
{
        struct eap_hdr *resp;
        unsigned int len;
        u8 identity_len = 0, ret;
        u8 imsi_id_len = 0;
        int mnc_len = -1;
        u8 *pos;
        int qmiRetCode;
        u8 idx = 0, mcc_idx = 0;
        unsigned char *identity = NULL;
        unsigned char *imsi_identity = NULL;
        auth_start_eap_session_req_msg_v01 eap_auth_start;
        auth_start_eap_session_resp_msg_v01 eap_auth_start_resp;
        auth_set_subscription_binding_req_msg_v01 sub_req_binding;
        auth_set_subscription_binding_resp_msg_v01 sub_resp_binding;

        struct eap_method_type *m;
        eap_identity_format_e identity_format = EAP_IDENTITY_ANNONYMOUS;
        Boolean simEnabled = FALSE, akaEnabled = FALSE;
        struct eap_peer_config *config = eap_get_config(eap_sm);
        const char *realm_3gpp = "@wlan.mnc000.mcc000.3gppnetwork.org";
        int sim_num;

        wpa_printf(MSG_ERROR, "eap_proxy: %s\n", __func__);
        sim_num = config->sim_num - 1;
        os_memset(&eap_auth_start, 0, sizeof(eap_auth_start));
        os_memset(&eap_auth_start_resp, 0, sizeof(eap_auth_start_resp));

        eap_auth_start.user_id_len = 0;
        m = config->eap_methods;

        if (sim_num >= MAX_NO_OF_SIM_SUPPORTED || sim_num < 0) {
                wpa_printf (MSG_ERROR, "eap_proxy: Invalid SIM selected sim by user = %d\n",
                             sim_num+1);
                return FALSE;
        }
        wpa_printf(MSG_ERROR, "eap_proxy: User selected sim = %d\n", sim_num + 1);

        if (m != NULL) {
                for (idx = 0; m[idx].vendor != EAP_VENDOR_IETF ||
                                m[idx].method != EAP_TYPE_NONE; idx++) {
                        if (m[idx].method == EAP_TYPE_AKA) {
                                akaEnabled = TRUE;
                                eap_auth_start.eap_method_mask_valid = 1;
                                eap_auth_start.eap_method_mask |= QMI_AUTH_EAP_METHOD_MASK_AKA_V01;
                                wpa_printf(MSG_ERROR, "eap_proxy: AKA Enabled\n");
                        } else if (m[idx].method == EAP_TYPE_SIM) {
                                simEnabled = TRUE;
                                eap_auth_start.eap_method_mask_valid = 1;
                                eap_auth_start.eap_method_mask |= QMI_AUTH_EAP_METHOD_MASK_SIM_V01;
                                wpa_printf(MSG_ERROR, "eap_proxy: SIM Enabled\n");
#ifdef CONFIG_EAP_PROXY_AKA_PRIME
                        } else if (m[idx].method == EAP_TYPE_AKA_PRIME) {
                                eap_auth_start.eap_method_mask_valid = 1;
                                eap_auth_start.eap_method_mask |=
                                        QMI_AUTH_EAP_METHOD_MASK_AKA_PRIME_V01;
                                wpa_printf(MSG_ERROR, "eap_proxy: AKA Prime Enabled\n");
#endif /* CONFIG_EAP_PROXY_AKA_PRIME */
                        }
                }
        } else {
                wpa_printf(MSG_ERROR, "eap_proxy: eap_methods is NULL!\n");
                return FALSE;
        }

        eap_auth_start.eap_method_mask_valid = 1;

        idx = 0;
#ifdef SIM_AKA_IMSI_RAW_ENABLED

        identity_format = EAP_IDENTITY_IMSI_RAW;
        eap_auth_start.user_id_valid = 1;
        wpa_printf(MSG_ERROR, "eap_proxy: EAP_IDENTITY_IMSI_RAW selected %d \n",
                eap_auth_start.user_id_len);

#else /* SIM_AKA_IMSI_RAW_ENABLED */

        if (config->identity_len && config->identity != NULL) {
                for (idx = 0; idx < config->identity_len; idx++) {
                        if (config->identity[idx] == 64) {
                                wpa_printf(MSG_ERROR, "eap_proxy: @ found \n");
                                mcc_idx = idx;
                                if ((mcc_idx + 18) > config->identity_len)
                                        mcc_idx = 0;
                                else {
                                        /* Looking for mnc and mcc pattern */
                                        if (109 == config->identity[mcc_idx + 6] &&
                                                (110 == config->identity[mcc_idx + 7]) &&
                                                (99 == config->identity[mcc_idx + 8]) &&
                                                (109 == config->identity[mcc_idx + 13]) &&
                                                (99 == config->identity[mcc_idx + 14]) &&
                                                (99 == config->identity[mcc_idx + 15])) {
                                                mcc_idx += 9;
                                        } else
                                                mcc_idx = 0;
                                }
                                break;
                        }
                }

                wpa_printf(MSG_ERROR, "eap_proxy: idx %d\n", idx);
                wpa_printf(MSG_ERROR, "eap_proxy: mcc idx %d\n", mcc_idx);

                if (!idx && (config->identity_len == 1)) {
                        /* config file : @ */
                        config->identity_len = 0;
                        identity_format = EAP_IDENTITY_IMSI_3GPP_REALM;
                        wpa_printf(MSG_ERROR, "eap_proxy: EAP_IDENTITY_IMSI_3GPP_REALM "
                                "selected \n");
                } else if (idx && (idx < config->identity_len) && (config->identity != NULL)) {

                        /* config file : <>@<> or <>@<wlan.mnc000.mcc000.<>.<> */
                        identity_len = config->identity_len;
                        identity = os_malloc(config->identity_len);

                        if (NULL != identity) {
                                os_memset(identity, 0, config->identity_len);
                                os_memcpy(identity, config->identity,
                                                config->identity_len);
                        }

                        /* To Do for 3GPP realm */
                        identity_format = EAP_IDENTITY_CFG_3GPP_REALM;
                        eap_auth_start.user_id_valid = 1;
                        wpa_printf(MSG_ERROR, "eap_proxy: EAP_IDENTITY_CFG_3GPP_REALM "
                                "selected %d \n", eap_auth_start.user_id_len);

                } else if ((idx == config->identity_len) && config->identity_len &&
                                        (config->identity != NULL)) {

                        /* config file : <identity in RAW format >*/
                        identity_len = config->identity_len;
                        identity = os_malloc(config->identity_len);

                        if (NULL != identity) {
                                os_memset(identity, 0, config->identity_len);
                                os_memcpy(identity, config->identity,
                                                config->identity_len);
                        }

                        identity_format = EAP_IDENTITY_CFG_RAW;
                        eap_auth_start.user_id_valid = 1;
                        wpa_printf(MSG_ERROR, "eap_proxy: EAP_IDENTITY_CFG_RAW selected %d \n",
                                eap_auth_start.user_id_len);
                } else if (!idx && mcc_idx) {

                        /* config file: @wlan.mnc000.mcc000.<>.<> */
                        identity_len = config->identity_len;
                        identity = os_malloc(config->identity_len);

                        if (NULL != identity) {
                                os_memset(identity, 0, config->identity_len);
                                os_memcpy(identity, config->identity,
                                         config->identity_len);
                        }

                        identity_format = EAP_IDENTITY_IMSI_3GPP_REALM;
                        eap_auth_start.user_id_valid = 1;
                        wpa_printf(MSG_ERROR, "eap_proxy: config EAP_IDENTITY_IMSI_3GPP_REALM "
                                "selected %d\n", eap_auth_start.user_id_len);
                }
        } else {

                if (config->anonymous_identity_len && config->anonymous_identity != NULL) {

                        eap_auth_start.eap_meta_identity_len = config->anonymous_identity_len;
                        os_memcpy(&eap_auth_start.eap_meta_identity ,
                                                config->anonymous_identity ,
                                                config->anonymous_identity_len);

                        identity_format = EAP_IDENTITY_ANNONYMOUS;
                        eap_auth_start.eap_meta_identity_valid = 1;
                        wpa_printf(MSG_ERROR, "eap_proxy: EAP_IDENTITY_ANNONYMOUS selected user id "
                                "%d, annonymous %d\n", eap_auth_start.user_id_len,
                                eap_auth_start.eap_meta_identity_len);
                } else {
                        /* config file doesn't contain any identity
                                generating IMSI@realm */
                        identity_format = EAP_IDENTITY_IMSI_3GPP_REALM;
                        eap_auth_start.user_id_valid = 1;
                        wpa_printf(MSG_ERROR, "eap_proxy: EAP_IDENTITY_IMSI_3GPP_REALM id len %d\n",
                                eap_auth_start.user_id_len);
                }
        }
#endif /* SIM_AKA_IMSI_RAW_ENABLED */
        if (identity_format == EAP_IDENTITY_IMSI_3GPP_REALM ||
                identity_format == EAP_IDENTITY_IMSI_RAW || mcc_idx) {

                wpa_printf(MSG_ERROR, "eap_proxy: EAP_IDENTITY_IMSI_3GPP_REALM is selected\n");
                if (!wpa_qmi_read_card_status(sim_num, eap_proxy->wpa_uim)) {
                        wpa_printf(MSG_INFO, "eap_proxy: Read Card Status failed, return\n");
                        if (NULL != identity) {
                                os_free(identity);
                                identity = NULL;
                        }
                        return FALSE;
                }

                if (!wpa_qmi_read_card_imsi(sim_num, eap_proxy->wpa_uim)) {
                        wpa_printf(MSG_INFO, "eap_proxy: Read Card IMSI failed, return\n");
                        if (NULL != identity) {
                                os_free(identity);
                                identity = NULL;
                        }
                        return FALSE;
                }

                if (imsi == NULL) {
                        wpa_printf(MSG_INFO, "eap_proxy: IMSI not available, return\n");
                        if (NULL != identity) {
                                os_free(identity);
                                identity = NULL;
                        }
                        return FALSE;
                } else {
                        wpa_printf(MSG_ERROR, "eap_proxy: IMSI not NULL \n");
                        if (NULL == identity)
                                wpa_printf(MSG_ERROR,
                                        "eap_proxy: config file doesn't contain identity \n");
                        else
                                wpa_printf(MSG_ERROR, "eap_proxy: config file contains identity\n");

                        wpa_printf(MSG_ERROR, "eap_proxy: eap_type: %d\n", eap_proxy->eap_type);

                        if (!idx) {

                                /* IMSI is expected as username */
                                wpa_printf(MSG_ERROR, "eap_proxy:  username is not available in"
                                        " config picking IMSI \n");

                                if (config->identity_len > 1)
                                        /* @realm provided in config */
                                        imsi_identity =
                                                os_malloc(1 + IMSI_LENGTH + config->identity_len);
                                else if (identity_format == EAP_IDENTITY_IMSI_3GPP_REALM)
                                        /* IMSI@realm not provided through config */
                                        imsi_identity =
                                                os_malloc(1 + IMSI_LENGTH + os_strlen(realm_3gpp));
                                else
                                        /* IMSI RAW */
                                        imsi_identity = os_malloc(1 + IMSI_LENGTH);

                                if (NULL == imsi_identity) {
                                        wpa_printf(MSG_ERROR, "eap_proxy: Memory not available\n");
                                        if (NULL != identity) {
                                                os_free(identity);
                                                identity = NULL;
                                        }
                                        return FALSE;
                                } else {
                                        if (config->identity_len > 1)
                                                os_memset(imsi_identity, 0,
                                                        (1 + IMSI_LENGTH + config->identity_len));
                                        else if (identity_format == EAP_IDENTITY_IMSI_3GPP_REALM)
                                                os_memset(imsi_identity, 0,
                                                        (1 + IMSI_LENGTH + os_strlen(realm_3gpp)));
                                        else
                                                os_memset(imsi_identity, 0, (1 + IMSI_LENGTH));

                                        if (eap_proxy->eap_type == EAP_TYPE_SIM)
                                                imsi_identity[0] = '1';
                                        else if (eap_proxy->eap_type == EAP_TYPE_AKA)
                                                imsi_identity[0] = '0';
#ifdef CONFIG_EAP_PROXY_AKA_PRIME
                                        else if (eap_proxy->eap_type == EAP_TYPE_AKA_PRIME)
                                                imsi_identity[0] = '6';
#endif /* CONFIG_EAP_PROXY_AKA_PRIME */
                                        else
                                                /* Default value is set as SIM */
                                                imsi_identity[0] = '1';

                                        /* copying IMSI value */
                                        os_memcpy(imsi_identity + 1 , imsi , imsi_len_g);

                                        if (config->identity_len > 1 && NULL != identity) {
                                                /* copying realm tag */
                                                os_memcpy(imsi_identity + 1 + imsi_len_g , identity,
                                                        config->identity_len);
                                                imsi_id_len = imsi_len_g + 1 + config->identity_len;
                                                os_free(identity);
                                                identity = NULL;
                                        } else if(identity_format == EAP_IDENTITY_IMSI_3GPP_REALM) {
                                                /* realm is not available so append it */
                                                os_memcpy(imsi_identity + 1 + imsi_len_g,
                                                        realm_3gpp, os_strlen(realm_3gpp));
                                                imsi_id_len = imsi_len_g + 1 +
                                                        os_strlen(realm_3gpp);
                                        } else
                                                /* IMSI RAW */
                                                imsi_id_len = imsi_len_g + 1;
                                }
                        } else if (identity) {
                                /* idx is non-zero implies username available */
                                imsi_identity = identity;
                                imsi_id_len = config->identity_len;
                        }
                }

                if (identity_format == EAP_IDENTITY_IMSI_3GPP_REALM || mcc_idx) {

                        if (0 == idx) {
                        /* id = @wlan.mnc000.mcc000.<>.<> realm exist
                                but need to insert mnc and mcc values */
                                idx = imsi_len_g + 1;
                        }

                        if (imsi_identity != NULL) {
                                /* mcc valus */
                                imsi_identity[idx + 16] = imsi[0];
                                imsi_identity[idx + 17] = imsi[1];
                                imsi_identity[idx + 18] = imsi[2];
                        }

                        /* mnc valus */
                        mnc_len = card_mnc_len;
                        wpa_printf(MSG_ERROR, "eap_proxy: card mnc len %d\n", card_mnc_len);

                        if ((mnc_len == 2) && (imsi_identity != NULL)) {
                                imsi_identity[idx + 9]  = '0';
                                imsi_identity[idx + 10] = imsi[3];
                                imsi_identity[idx + 11] = imsi[4];
                        } else if ((mnc_len == 3) && (imsi_identity != NULL)) {
                                imsi_identity[idx + 9]  = imsi[3];
                                imsi_identity[idx + 10] = imsi[4];
                                imsi_identity[idx + 11] = imsi[5];
                        }
                        wpa_printf(MSG_ERROR, "eap_proxy:  Appending 3gpp realm\n ");
                }
                identity = imsi_identity;
                identity_len = imsi_id_len;
                eap_auth_start.user_id_valid = 1;
        }

        eap_auth_start.user_id_len = identity_len;

        if(identity_len >= QMI_AUTH_EAP_IDENTITY_MAX_CHAR_V01)
        {
                wpa_printf(MSG_ERROR, "eap_proxy: Invalid User Identity length =%d",identity_len);
                return FALSE;
        }

        if(identity)
        {
                memcpy(&eap_auth_start.user_id, identity, identity_len);
                eap_auth_start.user_id_valid = 1;
        }

        wpa_printf(MSG_ERROR, "eap_proxy: eap auth user identity  - %20s length-%d\n ",
                    eap_auth_start.user_id, eap_auth_start.user_id_len);

        if ( (sim_num < 0) || (sim_num >= MAX_NO_OF_SIM_SUPPORTED)) {
                wpa_printf(MSG_ERROR, "eap_proxy: SIM: Invalid SIM selected by "
                            "User: Selected sim = %d\n", sim_num+1);
                return FALSE;
        }


        eap_proxy->user_selected_sim = sim_num;
        wpa_printf(MSG_ERROR, "eap_proxy: SIM selected by User: Selected sim = %d\n",
                    eap_proxy->user_selected_sim+1);

        memset(&sub_req_binding, 0, sizeof(auth_set_subscription_binding_req_msg_v01));
        memset(&sub_resp_binding, 0, sizeof(auth_set_subscription_binding_resp_msg_v01));
#ifdef CONFIG_EAP_PROXY_DUAL_SIM
        if (sim_num == 0) {
                sub_req_binding.bind_subs = AUTH_PRIMARY_SUBS_V01;
                qmiRetCode = qmi_client_send_msg_sync(eap_proxy->qmi_auth_svc_client_ptr[sim_num],
                                QMI_AUTH_SET_SUBSCRIPTION_BINDING_REQ_V01,
                                                (void *) &sub_req_binding,
                                                sizeof(auth_set_subscription_binding_req_msg_v01),
                                                (void *) &sub_resp_binding,
                                                sizeof(auth_set_subscription_binding_resp_msg_v01),
                                                WPA_UIM_QMI_DEFAULT_TIMEOUT);

                if ((QMI_NO_ERR != qmiRetCode ||
                     sub_resp_binding.resp.result != QMI_RESULT_SUCCESS_V01 ) &&
                    (QMI_ERR_OP_DEVICE_UNSUPPORTED_V01 != sub_resp_binding.resp.error)) {
                        wpa_printf(MSG_ERROR, "QMI-ERROR Unable to get the qmi_auth_set_subscriptio"
                                "n_binding for sim 1; error_ret=%d; error_code=%d\n", qmiRetCode,
                                sub_resp_binding.resp.error);
                        return FALSE;
                }
                wpa_printf (MSG_ERROR, "eap_proxy: Binded with PRIMARY Subscription\n");
        } else if (sim_num == 1) {
                sub_req_binding.bind_subs = AUTH_SECONDARY_SUBS_V01;
                qmiRetCode = qmi_client_send_msg_sync(eap_proxy->qmi_auth_svc_client_ptr[sim_num],
                                QMI_AUTH_SET_SUBSCRIPTION_BINDING_REQ_V01,
                                                (void *) &sub_req_binding,
                                                sizeof(auth_set_subscription_binding_req_msg_v01),
                                                (void *) &sub_resp_binding,
                                                sizeof(auth_set_subscription_binding_resp_msg_v01),
                                                WPA_UIM_QMI_DEFAULT_TIMEOUT);

                if (QMI_NO_ERR != qmiRetCode ||
                    sub_resp_binding.resp.result != QMI_RESULT_SUCCESS_V01 ) {
                        wpa_printf(MSG_ERROR, "QMI-ERROR Unable to get the qmi_auth_set_subscriptio"
                                "n_binding for sim 2; error_ret=%d; error_code=%d\n", qmiRetCode,
                                sub_resp_binding.resp.error);
                        return FALSE;
                }

                wpa_printf (MSG_ERROR, "eap_proxy: Binded with SECONDARY Subscription\n");
        } else {
                wpa_printf(MSG_ERROR, "eap_proxy: Invalid SIM selected by User: "
                        "Selected sim = %d\n", sim_num+1);
                return FALSE;
        }
#endif
        if (TRUE == eap_proxy->eap_auth_session_flag[sim_num]) {
                if(eap_auth_end_eap_session(eap_proxy->qmi_auth_svc_client_ptr[sim_num]) < 0) {
                        wpa_printf(MSG_ERROR, "eap_proxy: Unable to end the EAP session;"
                                                " sim_num%d;", sim_num);
                        }
                        eap_proxy->eap_auth_session_flag[sim_num] = FALSE;
        }

        if (FALSE == eap_proxy->eap_auth_session_flag[sim_num]) {
                        wpa_printf(MSG_ERROR, "eap_proxy: eap_auth_start values\n");
                        wpa_printf(MSG_ERROR, "eap_proxy: eap_auth_start.eap_method_mask = %d\n",
                                eap_auth_start.eap_method_mask);
                        wpa_printf(MSG_ERROR, "eap_proxy: eap_auth_start.user_id_len = %d\n",
                                eap_auth_start.user_id_len);
                        wpa_printf(MSG_ERROR, "eap_proxy: eap_auth_start.eap_meta_id_len = %d\n",
                                eap_auth_start.eap_meta_identity_len);
                        wpa_printf(MSG_ERROR, "eap_auth_start.eap_sim_aka_algo = %d\n",
                                eap_auth_start.eap_sim_aka_algo);
        qmiRetCode = qmi_client_send_msg_sync(eap_proxy->qmi_auth_svc_client_ptr[sim_num],
                                                QMI_AUTH_START_EAP_SESSION_REQ_V01,
                                                (void *) &eap_auth_start,
                                                sizeof(auth_start_eap_session_req_msg_v01),
                                                (void *) &eap_auth_start_resp,
                                                sizeof(auth_start_eap_session_resp_msg_v01),
                                                WPA_UIM_QMI_DEFAULT_TIMEOUT);
        if (QMI_NO_ERR != qmiRetCode ||
            eap_auth_start_resp.resp.result != QMI_RESULT_SUCCESS_V01) {
                wpa_printf(MSG_ERROR, " QMI-ERROR Unable to start the EAP session;"
                           " error_ret=%d; qmi_err=%d\n", qmiRetCode,
                           eap_auth_start_resp.resp.error);
                if(eap_auth_start.eap_method_mask == QMI_AUTH_EAP_METHOD_MASK_AKA_PRIME_V01 &&
                   eap_auth_start_resp.resp.error == QMI_ERR_INVALID_ARG_V01)
                        wpa_printf(MSG_ERROR, "QMI-ERROR AKA' not supported\n");

                return FALSE;
                }
                eap_proxy->eap_auth_session_flag[sim_num] = TRUE;
                eap_proxy->notification_code = 0;
                eap_proxy->qmi_state = QMI_STATE_IDLE;
                wpa_printf(MSG_ERROR, "eap_proxy: EAP session started"
                           " error_ret=%d; Resp=%d\n", qmiRetCode,
                            eap_auth_start_resp.resp.error);
        }

        return TRUE;
}


#ifdef CONFIG_CTRL_IFACE

/**
 * eap_proxyl_sm_get_status - Get EAP state machine status
 * @sm: Pointer to EAP state machine allocated with eap_sm_init()
 * @buf: Buffer for status information
 * @buflen: Maximum buffer length
 * @verbose: Whether to include verbose status information
 * Returns: Number of bytes written to buf.
 *
 * Query EAP state machine for status information. This function fills in a
 * text area with current status information from the EAPOL state machine. If
 * the buffer (buf) is not large enough, status information will be truncated
 * to fit the buffer.
 */
int eap_proxy_sm_get_status(struct eap_proxy_sm *sm, char *buf, size_t buflen,
                            int verbose)
{
        int len, ret;

        if (sm == NULL)
                return 0;

        len = os_snprintf(buf, buflen, "eap_proxy: EAP state=%s\n",
                          eap_proxy_sm_state_txt(sm->proxy_state));
        if (len < 0 || (size_t)len >= buflen)
                return 0;

        if (sm->eap_type != EAP_TYPE_NONE) {
                char name[8];

                if (sm->eap_type == EAP_TYPE_SIM)
                        os_strlcpy(name, "SIM", 4);
                else if (sm->eap_type == EAP_TYPE_AKA)
                        os_strlcpy(name, "AKA", 4);
                else if (sm->eap_type == EAP_TYPE_AKA_PRIME)
                        os_strlcpy(name, "AKA'", 5);
                else
                        os_strlcpy(name, "Unknown", 8);

                ret = os_snprintf(buf + len, buflen - len,
                                "selectedMethod=%d (EAP-%s)\n",
                                        sm->eap_type, name);
                if (ret < 0 || (size_t)ret >= buflen - len)
                        return len;
                len += ret;
        }

        return len;
}


static const char *eap_proxy_sm_state_txt(int state)
{
        switch (state) {
        case EAP_PROXY_INITIALIZE:
                return "INITIALIZE";
        case EAP_PROXY_DISABLED:
                return "DISABLED";
        case EAP_PROXY_IDLE:
                return "IDLE";
        case EAP_PROXY_RECEIVED:
                return "RECEIVED";
        case EAP_PROXY_GET_METHOD:
                return "GET_METHOD";
        case EAP_PROXY_METHOD:
                return "METHOD";
        case EAP_PROXY_SEND_RESPONSE:
                return "SEND_RESPONSE";
        case EAP_PROXY_DISCARD:
                return "DISCARD";
        case EAP_PROXY_IDENTITY:
                return "IDENTITY";
        case EAP_PROXY_NOTIFICATION:
                return "NOTIFICATION";
        case EAP_PROXY_RETRANSMIT:
                return "RETRANSMIT";
        case EAP_PROXY_AUTH_SUCCESS:
                return "SUCCESS";
        case EAP_PROXY_AUTH_FAILURE:
                return "FAILURE";
        default:
                return "UNKNOWN";
        }
}
#endif /* CONFIG_CTRL_IFACE */


/**
 * eap_proxy_get_mcc_mnc - Get MCC/MNC
 * @imsi_buf: Buffer for returning IMSI
 * @imsi_len: Buffer for returning IMSI length
 * Returns: MNC length (2 or 3) or -1 on error
 */
int eap_proxy_get_imsi(struct eap_proxy_sm *eap_proxy, char *imsi_buf,
                        size_t *imsi_len)
{
#ifdef SIM_AKA_IDENTITY_IMSI
        int mnc_len;
        int sim_num = eap_proxy->user_selected_sim;

        if ((eap_proxy->proxy_state == EAP_PROXY_DISABLED) ||
            (eap_proxy->proxy_state == EAP_PROXY_INITIALIZE)) {
                wpa_printf(MSG_ERROR, "eap_proxy:%s: Not initialized\n", __func__);
                return FALSE;
        }
        if (!wpa_qmi_read_card_status(sim_num, eap_proxy->wpa_uim)) {
        wpa_printf(MSG_INFO, "eap_proxy: Card not ready");
                return -1;
        }

        if (!wpa_qmi_read_card_imsi(sim_num, eap_proxy->wpa_uim) || imsi == NULL) {
                wpa_printf(MSG_INFO, "eap_proxy: Failed to read card IMSI");
                return -1;
        }

        *imsi_len = os_strlen(imsi);
        os_memcpy(imsi_buf, imsi, *imsi_len + 1);

        mnc_len = card_mnc_len;
        if (mnc_len < 2 || mnc_len > 3)
                mnc_len = 3; /* Default to 3 if MNC length is unknown */

        os_free(imsi);
        imsi = NULL;

        return mnc_len;
#else /* SIM_AKA_IDENTITY_IMSI */
        return -1;
#endif /* SIM_AKA_IDENTITY_IMSI */
}

int eap_proxy_notify_config(struct eap_proxy_sm *eap_proxy,
                            struct eap_peer_config *config)
{
        int ret_val;

        wpa_printf(MSG_ERROR, "eap_proxy: eap_proxy_notify_config\n");
        if (!eap_proxy) {
                wpa_printf(MSG_ERROR, "eap_proxy: is NULL");
                return FALSE;
        }

        if ((eap_proxy->proxy_state == EAP_PROXY_DISABLED) ||
            (eap_proxy->proxy_state == EAP_PROXY_INITIALIZE)) {
                wpa_printf(MSG_ERROR, "eap_proxy: Not initialized\n");
                return FALSE;
        }

        if ( config && eap_proxy_allowed_method(config, EAP_VENDOR_IETF,
                        EAP_TYPE_SIM)) {
                eap_proxy->eap_type =  EAP_TYPE_SIM;
                ret_val = TRUE;
        } else if ( config && eap_proxy_allowed_method(config, EAP_VENDOR_IETF,
                                EAP_TYPE_AKA)) {
                eap_proxy->eap_type =  EAP_TYPE_AKA;
                ret_val = TRUE;
        } else if ( config && eap_proxy_allowed_method(config, EAP_VENDOR_IETF,
                                EAP_TYPE_AKA_PRIME)) {
                eap_proxy->eap_type =  EAP_TYPE_AKA_PRIME;
                ret_val = TRUE;
        } else
                ret_val = FALSE;

        return ret_val;
}

int eap_proxy_allowed_method(struct eap_peer_config *config, int vendor,
                              u32 method)
{
        int i;
        struct eap_method_type *m;

        wpa_printf(MSG_ERROR, "eap_proxy: eap_proxy_allowed_method");
        if (config == NULL || config->eap_methods == NULL)
                return -1;

        m = config->eap_methods;
        for (i = 0; m[i].vendor != EAP_VENDOR_IETF ||
                     m[i].method != EAP_TYPE_NONE; i++) {
                if (m[i].vendor == vendor && m[i].method == method)
                        return 1;
        }
        return 0;
}

#endif  /* CONFIG_EAP_PROXY */