fc-tourmaline: src/g23m-aci/aci/aci

comparison src/g23m-aci/aci/aci_slock.c @ 1:fa8dc04885d8

src/g23m-*: import from Magnetite

author	Mychaela Falconia <falcon@freecalypso.org>
date	Fri, 16 Oct 2020 06:25:50 +0000
parents
children

comparison

equal deleted inserted replaced

-:4e78acac3d88
+:fa8dc04885d8
+/*
++-----------------------------------------------------------------------------
+|  Project :
+|  Modul   :  J:\g23m-aci\aci\aci_slock.c
++-----------------------------------------------------------------------------
+|  Copyright 2002 Texas Instruments Berlin, AG
+|                 All rights reserved.
+|
+|                 This file is confidential and a trade secret of Texas
+|                 Instruments Berlin, AG
+|                 The receipt of or possession of this file does not convey
+|                 any rights to reproduce or disclose its contents or to
+|                 manufacture, use, or sell anything it may describe, in
+|                 whole, or in part, without the specific written consent of
+|                 Texas Instruments Berlin, AG.
++-----------------------------------------------------------------------------
+|  Purpose :
++-----------------------------------------------------------------------------
+*/
+#ifdef SIM_PERS
+#include "aci_all.h"
+#include "aci_cmh.h"
+#include "ati_cmd.h"
+#include "aci_cmd.h"
+#ifdef FAX_AND_DATA
+#include "aci_fd.h"
+#endif /* FAX_AND_DATA */
+#include "aci.h"
+#include "psa.h"
+#include "psa_sim.h"
+#include "psa_sms.h"
+#include "psa_mmi.h"
+#include "cmh.h"
+#include "dti_conn_mng.h"
+#include "cmh_sim.h"
+#include "phb.h"
+#include "aoc.h"
+#include "psa_sim.h"            /* simShrdPrm */
+#include "aci_ext_pers.h"       /* we are using personalisation extensions */
+#include "aci_slock.h"          /* in order to asure interfaces */
+#include "l4_tim.h"
+/* Remember actual stati of already checked locks */
+GLOBAL T_ACI_SLOCK_SHARED AciSLockShrd;
+GLOBAL UBYTE sim_code_present_in_me; /* used by personalisation */
+GLOBAL T_ACI_SIM_CONFIG aci_slock_sim_config;     /* SIM configuration, initialised by a T_SIM_MMI_INSERT_IND */
+#include "general.h"  /* inluded for UINT8 compilation error in sec_drv.h */
+#include "sec_drv.h"
+GLOBAL T_SEC_DRV_CONFIGURATION *cfg_data ;
+EXTERN T_SEC_DRV_CATEGORY *personalisation_nw;
+EXTERN T_SEC_DRV_CATEGORY *personalisation_ns;
+EXTERN T_SEC_DRV_CATEGORY *personalisation_sp;
+EXTERN T_SEC_DRV_CATEGORY *personalisation_cp;
+EXTERN T_SEC_DRV_CATEGORY *personalisation_sim;
+EXTERN T_SEC_DRV_CATEGORY *personalisation_bnw;
+EXTERN T_SEC_DRV_CATEGORY *personalisation_first_sim;
+EXTERN void  psaSAT_FUConfirm       ( int, USHORT );
+void aci_slock_start_timer(void);
+const UBYTE mnc_mcc[6] = "00101"; /* 04-08-2005  */
+LOCAL UBYTE aci_slock_sim_service_table [10];     /* SIM service table        */
+LOCAL T_SIMLOCK_STATUS aci_slock_check_done(T_SIMLOCK_STATUS sl_status);
+EXTERN T_SIM_MMI_INSERT_IND *last_sim_mmi_insert_ind;
+/*
+* Conversion Table for setting the CPIN response parameter
+*/
+const UBYTE aci_set_cpin_response [SIMLOCK_LAST][2] = {
+{ CPIN_RSLT_PhNetPukReq    , CPIN_RSLT_PhNetPinReq    },
+{ CPIN_RSLT_PhNetSubPukReq , CPIN_RSLT_PhNetSubPinReq },
+{ CPIN_RSLT_PhSPPukReq     , CPIN_RSLT_PhSPPinReq     },
+{ CPIN_RSLT_PhCorpPukReq   , CPIN_RSLT_PhCorpPinReq   },
+{ CPIN_RSLT_PhSimFail      , CPIN_RSLT_PhSimPinReq    },
+{ CPIN_RSLT_PhFSimPukReq   , CPIN_RSLT_PhFSimPinReq   },
+{ CPIN_RSLT_PhBlockedNetPukReq	  , CPIN_RSLT_PhBlockedNetPinReq}
+};
+/*
+* Conversion Table for setting the CME ERROR Code
+*/
+const UBYTE set_cme_error_code [SIMLOCK_LAST][2] = {
+{ CME_ERR_NetworkPersPukReq       , CME_ERR_NetworkPersPinReq       },
+{ CME_ERR_NetworkSubsetPersPukReq , CME_ERR_NetworkSubsetPersPinReq },
+{ CME_ERR_ProviderPersPukReq      , CME_ERR_ProviderPersPinReq      },
+{ CME_ERR_CorporatePersPukReq     , CME_ERR_CorporatePersPinReq     },
+{ CME_ERR_PhoneFail               , CME_ERR_PhSimPinReq             },
+{ CME_ERR_PhFSimPukReq            , CME_ERR_PhFSimPinReq            },
+{ EXT_ERR_BlockedNetworkPersPukReq, EXT_ERR_BlockedNetworkPersPinReq }
+};
+LOCAL BOOL aci_slock_compare_codegroup_with_MEPD( UBYTE personalisation,
+UINT16 *index,
+UBYTE *imsi_sim,
+UBYTE code_len,
+UBYTE len,
+UBYTE *pBody ,BOOL bnw_flag);
+LOCAL UBYTE aci_slock_compare_NSCode ( UBYTE *me_nw_code,
+UBYTE *me_nw_ns_code_str,
+UBYTE *imsi_sim );
+LOCAL UBYTE aci_slock_compare_MSINCode( UBYTE *me_nw_ns_msin_msin_code_str,
+UBYTE *imsi_sim );
+LOCAL int aci_slock_extractCode( UBYTE *source_str, UBYTE len );
+LOCAL UBYTE aci_slock_check_isNSCodePresent( UBYTE *me_nw_code,
+UBYTE *imsi_sim,
+UINT16 *index );
+LOCAL UBYTE aci_slock_compare_gid_str( UBYTE *imsi_me,
+UBYTE *imsi_sim,
+UINT16 *index,
+T_SIM_SRV grp_lvl);
+LOCAL UBYTE aci_slock_compare_gid( UBYTE *me_gid_str,
+UBYTE *sim_gidl,
+UBYTE *sim_gid_str,
+UBYTE gid_len,
+UBYTE *pBody,
+UINT16 *index );
+LOCAL UBYTE aci_slock_check_isgidPresent( UBYTE *pBody,
+UBYTE *imsi_sim,
+UBYTE *imsi_me,
+T_SIM_SRV grp_lvl, UINT16 *index );
+LOCAL void aci_slock_decode_MEPD( UBYTE *pBody,
+UINT16 *index,
+UBYTE code_len,
+UBYTE *imsi_ascii );
+LOCAL void aci_slock_set_me_personalisation_status( UBYTE personalisation,
+UBYTE status );
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_init
++------------------------------------------------------------------------------
+|  Description : Initialising of this module. Has to be called first and *once only* before
+|                     calling any other method.
+|
+|  Parameters  : None
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_init ( void )
+{
+TRACE_FUNCTION("aci_slock_init()");
+/* Initialise the ACI Personalisation extension */
+aci_ext_personalisation_init();
+AciSLockShrd.blocked = FALSE;
+}
+/*
+Temporary Unlocks the lock of the given type after verifying the given password.
+The ACI extension for password verifying (see 2.3.9.1) will be used to
+determine if the given password is correct or not.
+On a successful unlock the actual status of the lock will be returned.
+If an error occurred SIMLOCK_FAIL will be returned.
+(Uses the ACI extension "personalisation data access".)
+*/
+T_SIMLOCK_STATUS aci_slock_authenticate ( T_SIMLOCK_TYPE type, char *passwd )
+{
+T_SIMLOCK_STATUS result;
+TRACE_FUNCTION("aci_slock_authenticate()");
+if(!aci_slock_set_CFG())
+{
+return SIMLOCK_FAIL;
+}
+result = aci_ext_personalisation_verify_password(type, passwd);
+if ( (result EQ SIMLOCK_DISABLED) AND (AciSLockShrd.blocked)) /* If lock is checked as blocked at the moment uncheck it! */
+{
+AciSLockShrd.blocked = !(AciSLockShrd.current_lock EQ type);
+}
+MFREE(cfg_data);
+if(result EQ SIMLOCK_FAIL)
+{
+if(!aci_slock_set_CFG())
+{
+return SIMLOCK_FAIL;
+}
+if(cfg_data->FC_Current >= cfg_data->FC_Max)
+{
+MFREE(cfg_data);
+return SIMLOCK_BLOCKED;
+}
+MFREE(cfg_data);
+}
+return result;
+}
+/*
+ACI method for retrieving the status of a single personalisation type. This method calls extension
+methods which in turn calls Security Drv. API and retrn the status of a personalisation category.
+The personalisation status is stored in MEPD which is directly accessed by Security Drv.
+Added on 11/03/2005
+*/
+T_SIMLOCK_STATUS aci_personalisation_get_status ( T_SIMLOCK_TYPE personalisation_type )
+{
+TRACE_FUNCTION("aci_personalisation_get_status ()");
+return aci_ext_personalisation_get_status(personalisation_type);
+}
+/* #endif */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_unlock
++------------------------------------------------------------------------------
+|  Description : Unlocks the lock of the given type after verifying the given password.
+|  The ACI extension for password verifying (see 2.3.9.1) will be used to
+|  determine if the given password is correct or not.
+|  On a successful unlock the actual status of the lock will be returned.
+|  If an error occurred SIMLOCK_FAIL will be returned.
+|  (Uses the ACI extension "personalisation data access".)
+|
+|  Parameters  : type       - Category Lock type
+|         passwd   - lock Password
+|
+|  Return      : SIMLOCK_FAIL = -1,
+|         SIMLOCK_DISABLED,      No SIM lock check has to be done
+|       SIMLOCK_PERM_DISABLED,
+|       SIMLOCK_ENABLED,       A SIM lock check has to be executed
+|       SIMLOCK_BLOCKED,       The SIM is blocked, i.e. because of a (or to many) wrong PIN(s)
+|        SIMLOCK_LOCKED         The ME is locked because of wrong SIM
+|
++------------------------------------------------------------------------------
+*/
+T_SIMLOCK_STATUS aci_slock_unlock ( T_SIMLOCK_TYPE type, char *passwd )
+{
+T_SIMLOCK_STATUS result;
+TRACE_FUNCTION("aci_slock_unlock()");
+if(aci_slock_is_timer_support() EQ TRUE)
+{
+if(aci_slock_check_timer() EQ TIMER_RUNNING)
+{
+return SIMLOCK_BUSY;
+}
+}
+if(!aci_slock_set_CFG())
+{
+return SIMLOCK_FAIL;
+}
+result = aci_ext_personalisation_set_status(type, SIMLOCK_DISABLED, passwd);
+if ( (result EQ SIMLOCK_DISABLED) AND (AciSLockShrd.blocked)) /* If lock is checked as blocked at the moment uncheck it! */
+{
+AciSLockShrd.blocked = !(AciSLockShrd.current_lock EQ type);
+}
+MFREE(cfg_data);
+if((result EQ SIMLOCK_BLOCKED) OR (result EQ SIMLOCK_FAIL))
+{
+aci_slock_start_timer();
+}
+return result;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_lock
++------------------------------------------------------------------------------
+|  Description :   Locks the lock of the given type.  On a successful lock the actual
+|  status of the lock will be returned. If an error occurred SIMLOCK_FAIL
+|  will be returned. This method will use the ACI extension for password
+|  verifying (see 2.3.9.1) to determine if the given password is correct
+|  or not. (Uses the ACI extension "personalisation data access".)
+|
+|  Parameters  : type       - Category Lock type
+|         passwd   - lock Password
+|
+|  Return      : SIMLOCK_FAIL = -1,
+|         SIMLOCK_DISABLED,      No SIM lock check has to be done
+|       SIMLOCK_PERM_DISABLED,
+|       SIMLOCK_ENABLED,       A SIM lock check has to be executed
+|       SIMLOCK_BLOCKED,       The SIM is blocked, i.e. because of a (or to many) wrong PIN(s)
+|        SIMLOCK_LOCKED         The ME is locked because of wrong SIM
+|
++------------------------------------------------------------------------------
+*/
+T_SIMLOCK_STATUS aci_slock_lock ( T_SIMLOCK_TYPE type, char *passwd )
+{
+T_SIMLOCK_STATUS result;
+T_SEC_DRV_RETURN ret;
+UBYTE imsi_sim[MAX_IMSI_LEN+1];
+int numUserCodeIdx;
+BOOL lock = TRUE;
+TRACE_FUNCTION("aci_slock_lock()");
+if(aci_slock_sim_config.sim_type EQ SIM_NORMAL)
+{
+if(!aci_slock_set_CFG())
+{
+return SIMLOCK_FAIL;
+}
+aci_ext_personalisation_init();
+result = aci_ext_personalisation_get_status( type );
+if(result EQ SIMLOCK_DISABLED)
+{
+if(cfg_data->AddNewIMSI & ( 0x0001 << type) )   /* 1-Apr-05 Bitmap check */
+{
+sim_code_present_in_me = FALSE;
+psaSIM_decodeIMSI(simShrdPrm.imsi.field, simShrdPrm.imsi.c_field, (char *)imsi_sim);
+switch(type)
+{
+case SIMLOCK_NETWORK: aci_slock_check_NWlock(imsi_sim, 1);break;
+case SIMLOCK_NETWORK_SUBSET: aci_slock_check_NSlock(imsi_sim, 1);break;
+case SIMLOCK_SIM: aci_slock_check_SMlock(imsi_sim, 1); break;
+/*Added cases for SP & CP below: 2nd April - 2005*/
+case SIMLOCK_SERVICE_PROVIDER:
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl1) )
+{
+if(aci_slock_sim_config.sim_read_gid1 EQ FALSE)
+{
+aci_slock_sim_read_sim(SIM_GID1, NOT_PRESENT_8BIT, MAX_GID);
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return SIMLOCK_WAIT;
+}
+}
+else
+{
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return SIMLOCK_FAIL;
+}
+aci_slock_check_SPlock(imsi_sim,1);break;
+case SIMLOCK_CORPORATE:
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl1))
+{
+if(aci_slock_sim_config.sim_read_gid1 EQ FALSE)
+{
+aci_slock_sim_read_sim(SIM_GID1, NOT_PRESENT_8BIT, MAX_GID);
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return SIMLOCK_WAIT;
+}
+}
+else
+{
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return SIMLOCK_FAIL;
+}
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl2))
+{
+if(aci_slock_sim_config.sim_read_gid2 EQ FALSE)
+{
+aci_slock_sim_read_sim(SIM_GID2, NOT_PRESENT_8BIT, MAX_GID);
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return SIMLOCK_WAIT;
+}
+}
+else
+{
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return SIMLOCK_FAIL;
+}
+aci_slock_check_CPlock(imsi_sim, 1);break;
+	    case SIMLOCK_BLOCKED_NETWORK:  sim_code_present_in_me = TRUE;
+		      break;
+default:TRACE_ERROR ("illegal type aci_slock_lock ()");
+return SIMLOCK_FAIL;
+}
+if (sim_code_present_in_me EQ FALSE)
+{
+/* changes for ETSI behavior  date : 01-Apr-05*/
+if (cfg_data->Flags & SEC_DRV_HDR_FLAG_ETSI_Flag)
+{
+ret = SEC_DRV_RET_Ok ;
+}
+else
+{
+ret = sec_cmp_KEY(type,passwd,0);
+}
+if(ret EQ SEC_DRV_RET_Ok)
+{
+aci_ext_add_code(type);
+}
+else
+{
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return SIMLOCK_FAIL;
+}
+}
+else if(sim_code_present_in_me EQ CHECK_FAIL)
+{
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return SIMLOCK_FAIL;
+}
+}
+/*
+* If there are no operator-defined codes or user-defined codes in the MEPD at all, do not lock the category
+*/
+switch(type)
+{
+case SIMLOCK_NETWORK :
+numUserCodeIdx =  OPCODE_LEN_INDEX + ((UBYTE *)personalisation_nw->pBody)[OPCODE_LEN_INDEX] + 1;
+if( (((UBYTE *) personalisation_nw->pBody)[OPCODE_LEN_INDEX] EQ 0) AND
+(((UBYTE *) personalisation_nw->pBody)[numUserCodeIdx] EQ 0) )
+{
+/*Do not lock the category*/
+lock = FALSE;
+}
+break;
+case SIMLOCK_NETWORK_SUBSET :
+numUserCodeIdx =  OPCODE_LEN_INDEX + ((UBYTE *)personalisation_ns->pBody)[OPCODE_LEN_INDEX] + 1;
+if( ( ((UBYTE *)personalisation_ns->pBody)[OPCODE_LEN_INDEX] EQ 0) AND
+( ((UBYTE *)personalisation_ns->pBody)[numUserCodeIdx] EQ 0) )
+{
+/*Do not lock the category*/
+lock = FALSE;
+}
+break;
+case SIMLOCK_SIM :
+numUserCodeIdx =  OPCODE_LEN_INDEX +((UBYTE *) personalisation_sim->pBody)[OPCODE_LEN_INDEX] + 1;
+if( (((UBYTE *) personalisation_sim->pBody)[OPCODE_LEN_INDEX] EQ 0) AND
+(((UBYTE *) personalisation_sim->pBody)[numUserCodeIdx] EQ 0) )
+{
+/*Do not lock the category*/
+lock = FALSE;
+}
+break;
+case SIMLOCK_SERVICE_PROVIDER:
+numUserCodeIdx =  OPCODE_LEN_INDEX + ((UBYTE *)personalisation_sp->pBody)[OPCODE_LEN_INDEX] + 1;
+if( ( ((UBYTE *)personalisation_sp->pBody)[OPCODE_LEN_INDEX] EQ 0) AND
+(((UBYTE *) personalisation_sp->pBody)[numUserCodeIdx] EQ 0) )
+{
+/*Do not lock the category*/
+lock = FALSE;
+}
+break;
+case SIMLOCK_CORPORATE:
+numUserCodeIdx =  OPCODE_LEN_INDEX + ((UBYTE *)personalisation_cp->pBody)[OPCODE_LEN_INDEX] + 1;
+if( ( ((UBYTE *)personalisation_cp->pBody)[OPCODE_LEN_INDEX] EQ 0) AND
+( ((UBYTE *)personalisation_cp->pBody)[numUserCodeIdx] EQ 0) )
+{
+/*Do not lock the category*/
+lock = FALSE;
+}
+break;
+case SIMLOCK_BLOCKED_NETWORK :
+numUserCodeIdx =  OPCODE_LEN_INDEX + ((UBYTE *)personalisation_bnw->pBody)[OPCODE_LEN_INDEX] + 1;
+if( (((UBYTE *) personalisation_bnw->pBody)[OPCODE_LEN_INDEX] EQ 0) AND
+(((UBYTE *) personalisation_bnw->pBody)[numUserCodeIdx] EQ 0) )
+{
+/*Do not lock the category*/
+lock = FALSE;
+}
+break;
+}
+if(lock EQ TRUE)
+{
+result = aci_ext_personalisation_set_status(type, SIMLOCK_ENABLED, passwd);
+}
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return result;
+}
+else
+{
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+return SIMLOCK_FAIL;
+}
+}
+else
+return SIMLOCK_FAIL;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_reset_fc
++------------------------------------------------------------------------------
+|  Description : This function is used to reset the Failure Counter
+|
+|  Parameters  : char* fcKey - Failure Reset Key
+|
+|  Return      :   OPER_FAIL
+|           OPER_SUCCESS
+|
++------------------------------------------------------------------------------
+*/
+T_OPER_RET_STATUS aci_slock_reset_fc ( char *fcKey )
+{
+T_OPER_RET_STATUS result;
+TRACE_FUNCTION("aci_slock_reset_fc ()");
+if(!aci_slock_set_CFG())
+{
+return OPER_FAIL;
+}
+if(cfg_data->Flags & SEC_DRV_HDR_FLAG_Unlock_Timer)
+{
+if(aci_slock_check_timer() EQ TIMER_RUNNING)
+{
+return OPER_BUSY;
+}
+}
+result = aci_ext_slock_reset_fc(fcKey);
+if(result EQ OPER_WRONG_PASSWORD)
+{
+aci_slock_start_timer();
+}
+return result ;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_sup_info
++------------------------------------------------------------------------------
+|  Description : This function is used to get the supplementary information like FCMAX,
+|      FCATTEMPTSLEFT,  FCRESETFAILMAX, FCRESETFAILATTEMPTSLEFT,
+|        FCRESETSUCCESSMAX, FCRESETSUCCESSATTEMPTSLEFT, TIMERFLAG,
+|      ETSIFLAG,  AIRTELINDFLAG
+|
+|  Parameters  : sup_info - Pointer to T_SUP_INFO
+|
+|  Return      :   OPER_FAIL
+|           OPER_SUCCESS
+|
++------------------------------------------------------------------------------
+*/
+T_OPER_RET_STATUS aci_slock_sup_info(T_SUP_INFO *sup_info)
+{
+TRACE_FUNCTION("aci_slock_sup_info()");
+return aci_ext_slock_sup_info (sup_info);
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_change_password
++------------------------------------------------------------------------------
+|  Description : This function is used to change the password of a category
+|
+|  Parameters  :     type - Category lock type
+|             passwd - Old  Control key
+|        new_passwd - New  Control key
+|
+|  Return      :  SIMLOCK_FAIL = -1,
+|         SIMLOCK_DISABLED,      No SIM lock check has to be done
+|       SIMLOCK_PERM_DISABLED,
+|       SIMLOCK_ENABLED,       A SIM lock check has to be executed
+|       SIMLOCK_BLOCKED,       The SIM is blocked, i.e. because of a (or to many) wrong PIN(s)
+|        SIMLOCK_LOCKED         The ME is locked because of wrong SIM
+|
++------------------------------------------------------------------------------
+*/
+T_OPER_RET_STATUS aci_slock_change_password ( T_SIMLOCK_TYPE type, char *passwd, char *new_passwd )
+{
+TRACE_FUNCTION("aci_slock_change_password()");
+return aci_ext_personalisation_change_password(type, passwd, new_passwd);
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_psaSIM_decodeIMSI
++------------------------------------------------------------------------------
+|  Description : convert imsi (packed bcd to ASCIIZ; ->11.11)
+|
+|  Parameters  :   imsi_field            - IMSI in BCD
+|                    imsi_c_field         -
+|                    imsi_asciiz           - ASCII IMSI
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void aci_slock_psaSIM_decodeIMSI (UBYTE* imsi_field,
+UBYTE  imsi_c_field,  CHAR* imsi_asciiz)
+{
+UBYTE imsi_len;
+UBYTE i;
+UBYTE digit;
+/*
+| 8 | 7 | 6 | 5 | 4 | 3 | 2 | 1 |
++---+---+---+---+---+---+---+---+
+imsi_c_field  = |         Length indicator      |
+imsi_field[0] = | IMSI digit 1  | p | 0 | 0 | 1 |
+imsi_field[1] = | IMSI digit 3  | IMSI digit 2  |
+imsi_c_field = length indicator:
+The length indicator refers to the number of significant bytes, not including this length byte,
+required for the IMSI.
+p = parity
+0: Even number of IMSI digits
+1: Odd number of IMSI digits
+If the number of IMSI digits is even then bits 5 to 8 of the last octet shall be filled with an end mark coded as 1111b
+*/
+/*
+*
+Check length
+*/
+if ((imsi_c_field EQ 0) OR (imsi_c_field > (MAX_IMSI-1)))  /* maybe 0xFF on some testcards */
+{
+TRACE_EVENT_P1("[WRN] imsi_c_field = %d is not valid", imsi_c_field);
+imsi_asciiz[0] = '\0';    /* return empty string in case of error */
+return;
+}
+/*
+* calculate number of digits
+*/
+imsi_len = (imsi_c_field)*2-1;   /* -1 goes off for parity nibble */
+/*
+* if even number of digits then last upper nibble is an end mark '1111'
+*/
+if ((imsi_field[0] & 0x08) EQ 0)
+{
+imsi_len--;
+}
+if ((imsi_field[0] & 0x08) EQ 0)
+{
+imsi_len--;
+}
+/*
+* extract all digits
+*/
+for (i=0; i<imsi_len; i++)
+{
+if ((i & 1) EQ 0)
+{
+/* process IMSI digit 1,3,5,... at i=0,2,4,...*/
+digit = (imsi_field[(i+1)/2] & 0xf0) >> 4;   /* +1 is to skip parity nibble */
+}
+else
+{
+/* process IMSI digit 2,4,6,... at i=1,3,5,...*/
+digit = (imsi_field[(i+1)/2] & 0x0f);
+}
+if (digit > 9)
+{
+imsi_asciiz[i] = 'F';
+/*  return;  */
+}
+else
+{
+imsi_asciiz[i] = '0' + digit;
+}
+}
+imsi_asciiz[i] = '\0';
+return;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_psaSIM_decodeIMSI_without_parity
++------------------------------------------------------------------------------
+|  Description : convert imsi (packed bcd to ASCIIZ; ->11.11)
+|
+|  Parameters  :   imsi_field            - IMSI in BCD
+|                    imsi_c_field         -
+|                    imsi_asciiz           - ASCII IMSI
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void aci_slock_psaSIM_decodeIMSI_without_parity(UBYTE* imsi_field,
+UBYTE  imsi_c_field,
+CHAR* imsi_asciiz)
+{
+UBYTE imsi_len;
+UBYTE i;
+UBYTE digit;
+/* TRACE_FUNCTION ("aci_slock_sim_decodeIMSI()"); */
+/*
+| 8 | 7 | 6 | 5 | 4 | 3 | 2 | 1 |
++---+---+---+---+---+---+---+---+
+imsi_c_field  = |         Length indicator      |
+imsi_field[0] = | IMSI digit 1  | p | 0 | 0 | 1 |
+imsi_field[1] = | IMSI digit 3  | IMSI digit 2  |
+imsi_c_field = length indicator:
+The length indicator refers to the number of significant bytes,
+not including this length byte, required for the IMSI.
+p = parity
+0: Even number of IMSI digits
+1: Odd number of IMSI digits
+If the number of IMSI digits is even then bits 5 to 8 of the last octet
+shall be filled with an end mark coded as 1111b
+*/
+/*
+* Check length
+*/
+if ((imsi_c_field EQ 0) OR (imsi_c_field > (MAX_IMSI-1)))  /* maybe 0xFF on some testcards */
+{
+TRACE_EVENT_P1("[WRN] imsi_c_field = %d is not valid", imsi_c_field);
+imsi_asciiz[0] = '\0';    /* return empty string in case of error */
+return;
+}
+/*
+* calculate number of digits
+*/
+imsi_len = (imsi_c_field)*2;
+/*
+* extract all digits
+*/
+for (i=0; i<imsi_len; i++)
+{
+if ((i & 1) EQ 0)
+{
+/* process IMSI digit 1,3,5,... at i=0,2,4,...*/
+digit = (imsi_field[i/2] & 0x0f);
+}
+else
+{
+/* process IMSI digit 2,4,6,... at i=1,3,5,...*/
+digit = (imsi_field[i/2] & 0xf0) >> 4;   /* +1 is to skip parity nibble */
+}
+if (digit > 9)
+{
+imsi_asciiz[i] = 'F';
+/*  return;  */
+}
+else
+{
+imsi_asciiz[i] = '0' + digit;
+}
+}
+imsi_asciiz[i] = '\0';
+return;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_NWlock
++------------------------------------------------------------------------------
+|  Description : Check IMSI against network personalisation
+|
+|  Parameters  :   imsi_sim            - IMSI
+|                    personalisation   - 0-add the lock data
+|                    1-verify the existing lock data
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_check_NWlock( UBYTE* imsi_sim, UBYTE  personalisation  )
+{
+UBYTE num_op_codes;
+UBYTE num_user_codes;
+UBYTE code_type;
+UBYTE i;
+UINT16 index =0;
+UBYTE imsi_me[MAX_IMSI_LEN+1];
+UBYTE isCodeFound;
+int   me_nw_code_first, me_nw_code_last, sim_nw_code;
+TRACE_FUNCTION("aci_slock_check_NWlock()");
+/*
+personalisation_nw->pBody[0] -----maximum number of user codes
+personalisation_nw->pBody[1] -----num of operator codes
+personalisation_nw->pBody[2] -----Operator Code-group length (To be set during configuration)
+where length =  total number of bytes occupied by operator codes
+Code type = 0x0a ( Type identifier for normal code)
+Normal code (Including parity nibble)  -- 4 bytes
+Code type = 0x0b (Type identifier for range)
+Start value (Including parity nibble) ---- 4 byte
+End value (Including parity nibble) -----4 byte
+Code type = 0x0c (Type identifier for regular expression)
+Regular Expression  -------------6 byte
+Number of User Codes  --- 1 byte
+Current user code index  --- 1 byte
+User code1  ------------4 byte
+*/
+/* TRACE_FUNCTION_P1("personalisation = %d",personalisation);  */
+if((personalisation_nw NEQ NULL) AND ((UBYTE *)personalisation_nw->pBody NEQ NULL))
+{
+index += MAX_NUM_USERCODE_SIZE;
+num_op_codes = ((UBYTE *)personalisation_nw->pBody)[index];
+index += NUM_OPCODE_SIZE;
+index +=OPCODE_LEN_SIZE;
+/* Implements NEW Mesaure */
+aci_slock_set_me_personalisation_status( personalisation, FALSE );
+/*
+* check operator defined code-groups
+*/
+for(i=0; i< num_op_codes; i++)
+{
+code_type =((UBYTE *) personalisation_nw->pBody)[index];
+index +=CODE_TYPE_SIZE;
+switch(code_type)
+{
+case NORMAL_CODE :
+/* Checks whether the NW Code is Matching with the
+* Network Personalisation DataBase
+*/
+if(aci_slock_compare_codegroup_with_MEPD( personalisation,
+&index,imsi_sim,
+NW_CODE_LEN,
+simShrdPrm.mnc_len+3,
+(UBYTE*)personalisation_nw->pBody,FALSE))
+{
+		return;
+}
+break;
+case INTERVAL_TYPE1 :
+	    /* Implements New Measure */
+aci_slock_decode_MEPD( (UBYTE *)personalisation_nw->pBody, &index,
+NW_CODE_LEN, imsi_me );
+/* to remove trailing F (if any) from imsi_me string */
+imsi_me[simShrdPrm.mnc_len+3] = '\0';
+me_nw_code_first = atoi((const char *)imsi_me);
+aci_slock_decode_MEPD( (UBYTE *)personalisation_nw->pBody, &index,
+NW_CODE_LEN, imsi_me );
+imsi_me[simShrdPrm.mnc_len+3] = '\0';
+me_nw_code_last = atoi((const char *)imsi_me);
+sim_nw_code = aci_slock_extractCode( imsi_sim, simShrdPrm.mnc_len+3 );
+isCodeFound = (sim_nw_code >= me_nw_code_first ) AND
+(sim_nw_code <= me_nw_code_last);
+aci_slock_set_me_personalisation_status ( personalisation,
+																isCodeFound );
+if( isCodeFound )
+{
+return;
+}
+break;
+case REGULAR_EXP :
+break;
+default :
+break;
+}
+}
+num_user_codes = ((UBYTE *)personalisation_nw->pBody)[index];
+index +=NUM_USER_CODE_SIZE;
+index +=CURR_USER_CODE_INDEX_SIZE;
+/*
+* check user defined code-groups
+*/
+for(i=0; i< num_user_codes; i++)
+{
+	/*
+* Checks whether the NW Code is Matching with the
+* Network Personalisation DataBase
+*/
+if(aci_slock_compare_codegroup_with_MEPD( personalisation,
+&index,imsi_sim,
+NW_CODE_LEN,
+simShrdPrm.mnc_len+3,
+(UBYTE*)personalisation_nw->pBody,FALSE))
+{
+		return;
+}
+}
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_NSlock
++------------------------------------------------------------------------------
+|  Description : Check IMSI against network subset personalisation
+|
+|  Parameters  :   imsi_sim            - IMSI
+|                    personalisation   - 0-add the lock data
+|                    1-verify the existing lock data
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_check_NSlock( UBYTE* imsi_sim, UBYTE  personalisation  )
+{
+UBYTE num_op_codes;
+UBYTE num_user_codes;
+UBYTE code_type;
+UBYTE cmp_result;
+UINT16 index =0;
+UBYTE me_nw_code[MAX_IMSI_LEN+1];
+UBYTE me_nw_ns_ns_code_str[6+2+2+1];
+int i ;
+TRACE_FUNCTION("aci_slock_check_NSlock()");
+/*
+personalisation_ns->pBody[0] -----maximum number of user codes
+personalisation_ns->pBody[1] -----num of operator codes
+personalisation_ns->pBody[2] -----Operator Code-group length (To be set during configuration)
+where length =  total number of bytes occupied by operator codes
+Code type = 0x0a ( Type identifier for normal code)
+Normal code (Including parity nibble)  -- 5 bytes  (Nw code + NS code)
+Code type = 0x0b (Type identifier for range)
+Network code --------- 4 byte
+Start value of NS code ---- 1 byte
+End value of NS code -----1 byte
+Code type = 0x0c (Type identifier for regular expression)
+Regular expression including Network + NS Code -------------8 byte
+Code type = 0x0d
+(8thdigit normal code/range)
+Network code (Including parity nibble) ------ 4 byte
+No. of  8th digit values for which normal codes and/or intervals are to be stored   ---- 1 byte
+8th digit value  -- 1 byte
+No. of normal codes to be associated with the digit (n1)  ---- 1 byte
+No. of intervals to be associated with the digit (n2)  ----- 1 byte
+Normal code 1   --- 1 byte
+|
+|
+|
+Normal code n1 ---- 1 byte
+Start value of interval 1  ---- 1 byte
+End value of interval 1   ---- 1 byte
+|
+|
+|
+Start value of interval n2  ------ 1 byte
+End value of interval n2  ------- 1 byte
+Number of User Codes   ------- 1 byt e
+Current user code index
+(for FIFO based addition/deletion of user codes)
+(should be set to 0xff if no user codes are present)  ---- 1 byte
+User code1             ---------- 5 byte
+User code 2      ---------- 5 byte
+|
+|
+User code n (n = Max number of user codes for NS)  -- 5 byte
+*/
+/* Implements NEW Mesaure */
+aci_slock_set_me_personalisation_status( personalisation, FALSE );
+if((personalisation_ns NEQ NULL) AND ((UBYTE *)personalisation_ns->pBody NEQ NULL))
+{
+index += MAX_NUM_USERCODE_SIZE;
+num_op_codes =((UBYTE *) personalisation_ns->pBody)[index];
+index += NUM_OPCODE_SIZE;
+index +=OPCODE_LEN_SIZE;
+/*
+* check operator defined code-groups
+*/
+for(i=0; i< num_op_codes; i++)
+{
+code_type = ((UBYTE *)personalisation_ns->pBody)[index];
+index +=CODE_TYPE_SIZE;
+switch(code_type)
+{
+case NORMAL_CODE :
+	 /*
+* Checks whether the NS Code is Matching with the
+* Network Subset Personalisation DataBase
+*/
+if (aci_slock_compare_codegroup_with_MEPD( personalisation,
+&index, imsi_sim,
+NW_NS_CODE_LEN,
+simShrdPrm.mnc_len+3+2,
+(UBYTE*)personalisation_ns->pBody,FALSE))
+{
+return;
+}
+break;
+case INTERVAL_TYPE1 :
+aci_slock_decode_MEPD( (UBYTE *)personalisation_ns->pBody, &index,
+NW_NS_NS_CODE_LEN, me_nw_ns_ns_code_str );
+memcpy(me_nw_code,me_nw_ns_ns_code_str,simShrdPrm.mnc_len+3);
+/* Compare the NS Code */
+cmp_result = aci_slock_compare_NSCode( me_nw_code,
+me_nw_ns_ns_code_str,
+imsi_sim );
+aci_slock_set_me_personalisation_status( personalisation,
+cmp_result );
+if ( cmp_result )
+{
+/*
+		  * The Network Code and the Network subset code matches,
+		  * hence return
+		  */
+return;
+}
+break;
+case INTERVAL_TYPE2 :
+TRACE_FUNCTION("INTERVAL_TYPE2");
+aci_slock_decode_MEPD( (UBYTE *)personalisation_ns->pBody, &index,
+NW_CODE_LEN, me_nw_code );
+index += 1;
+	 /* Implements Measure 212 */
+cmp_result = aci_slock_check_isNSCodePresent( me_nw_code, imsi_sim, &index );
+aci_slock_set_me_personalisation_status( personalisation, cmp_result );
+if ( cmp_result )
+{
+return;
+}
+break;
+case REGULAR_EXP :
+break;
+default :
+break;
+}
+}
+num_user_codes = ((UBYTE *)personalisation_ns->pBody)[index];
+index +=NUM_USER_CODE_SIZE;
+index +=CURR_USER_CODE_INDEX_SIZE;
+/*
+* check user defined code-groups
+*/
+for(i=0; i< num_user_codes; i++)
+{
+/* Checks whether the NS Code is Matching with the
+* Network Subset Personalisation DataBase
+*/
+if(aci_slock_compare_codegroup_with_MEPD( personalisation,
+&index, imsi_sim,
+NW_NS_CODE_LEN,
+simShrdPrm.mnc_len+3+2,
+(UBYTE*)personalisation_ns->pBody,FALSE))
+{
+return;
+}
+}
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_SPlock
++------------------------------------------------------------------------------
+|  Description : Check IMSI against service provider personalisation
+|
+|  Parameters  :   imsi_sim            - IMSI
+|                    personalisation   - 0-add the lock data
+|                    1-verify the existing lock data
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_check_SPlock( UBYTE* imsi_sim, UBYTE  personalisation )
+{
+UBYTE num_op_codes;
+UBYTE num_user_codes;
+UBYTE code_type;
+UBYTE cmp_result;
+UINT16 index =0;
+UBYTE imsi_me[MAX_IMSI_LEN+1];
+int  i;
+TRACE_FUNCTION("aci_slock_check_SPlock()");
+#if 0 // TISH patch for OMAPS00120012
+if((aci_slock_sim_config.sim_gidl1[0] EQ NOT_PRESENT_8BIT) OR (aci_slock_sim_config.gid1_len NEQ cfg_data->GID1_Len))
+#else
+if(aci_slock_sim_config.sim_gidl1[0] EQ NOT_PRESENT_8BIT)
+#endif
+{
+TRACE_FUNCTION_P1("aci_slock_sim_config.sim_gidl1[0] %d", aci_slock_sim_config.sim_gidl1[0]);
+if(!personalisation)
+{
+AciSLockShrd.blocked = TRUE;
+}
+else
+{
+sim_code_present_in_me = CHECK_FAIL;
+}
+return;
+}
+else
+{
+/*
+personalisation_sp->pBody[0] -----maximum number of user codes
+personalisation_sp->pBody[1] -----num of operator codes
+personalisation_sp->pBody[2] -----Operator Code-group length (To be set during configuration)
+where length =  total number of bytes occupied by operator codes
+Code type = 0x0a ( Type identifier for normal code)
+Normal code (Including parity nibble)  -- 8 bytes  (Network code + GID1 value)
+Code type = 0x0b (Type identifier for range)
+Network code --------- 4 byte
+Start GID1 ---- -------4 byte
+End GID1 -------------4 byte
+Code type = 0x0c (Type identifier for regular expression)
+Regular Expression (including NW code and GID1 value)  --- 10 byte
+Number of User Codes   ------- 1 byt e
+Current user code index
+(for FIFO based addition/deletion of user codes)
+(should be set to 0xff if no user codes are present)  ---- 1 byte
+User code1             ---------- 8 byte
+User code 2      ---------- 8 byte
+|
+|
+User code n (n = Max number of user codes for NS)  -- 8 byte
+*/
+aci_slock_set_me_personalisation_status( personalisation, FALSE );
+if((personalisation_sp NEQ NULL) AND ((UBYTE *)personalisation_sp->pBody NEQ NULL))
+{
+index += MAX_NUM_USERCODE_SIZE;
+num_op_codes = ((UBYTE *)personalisation_sp->pBody)[index];
+index += NUM_OPCODE_SIZE;
+index +=OPCODE_LEN_SIZE;
+/*
+* check operator defined code-groups
+*/
+for(i=0; i< num_op_codes; i++)
+{
+code_type = ((UBYTE *)personalisation_sp->pBody)[index];
+index +=CODE_TYPE_SIZE;
+if( ((code_type)&0xf0)>>4)
+{
+imsi_me[0] = 0;
+	}
+else
+	{
+	   aci_slock_decode_MEPD( (UBYTE *)personalisation_sp->pBody, &index,
+	                            NW_CODE_LEN, imsi_me );
+	}
+switch(code_type)
+{
+case NORMAL_CODE :
+cmp_result = aci_slock_check_isgidPresent( (UBYTE *)personalisation_sp->pBody,
+imsi_sim, imsi_me,
+SRV_GrpLvl1, &index );
+aci_slock_set_me_personalisation_status( personalisation,
+cmp_result );
+if (cmp_result)
+{
+return;
+}
+break;
+case INTERVAL_TYPE1 :
+cmp_result = aci_slock_compare_gid_str ( imsi_me, imsi_sim, &index,SRV_GrpLvl1);
+aci_slock_set_me_personalisation_status( personalisation, cmp_result );
+if (cmp_result)
+{
+return;
+}
+break;
+case REGULAR_EXP :
+break;
+default :
+break;
+}
+}
+num_user_codes = ((UBYTE *)personalisation_sp->pBody)[index];
+index +=NUM_USER_CODE_SIZE;
+index +=CURR_USER_CODE_INDEX_SIZE;
+/*
+* check user defined code-groups
+*/
+for(i=0; i< num_user_codes; i++)
+{
+aci_slock_decode_MEPD( (UBYTE *)personalisation_sp->pBody, &index,
+NW_CODE_LEN, imsi_me );
+cmp_result = aci_slock_check_isgidPresent( (UBYTE *)personalisation_sp->pBody,
+imsi_sim, imsi_me, SRV_GrpLvl1,&index );
+aci_slock_set_me_personalisation_status( personalisation,
+cmp_result );
+if (cmp_result)
+{
+return;
+}
+}
+}
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_CPlock
++------------------------------------------------------------------------------
+|  Description : Check IMSI against service corporate personalisation
+|
+|  Parameters  :   imsi_sim            - IMSI
+|                    personalisation   - 0-add the lock data
+|                    1-verify the existing lock data
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_check_CPlock( UBYTE* imsi_sim, UBYTE  personalisation)
+{
+UBYTE num_op_codes;
+UBYTE num_user_codes;
+UBYTE code_type;
+UBYTE cmp_result;
+UINT16 index =0;
+UBYTE imsi_me[MAX_IMSI_LEN+1];
+int i;
+TRACE_FUNCTION("aci_slock_check_CPlock()");
+#if 0  // TISH patch for OMAPS00120012
+if((aci_slock_sim_config.sim_gidl1[0] EQ NOT_PRESENT_8BIT) OR (aci_slock_sim_config.sim_gidl2[0] EQ NOT_PRESENT_8BIT)
+OR (aci_slock_sim_config.gid1_len NEQ cfg_data->GID1_Len) OR (aci_slock_sim_config.gid2_len NEQ cfg_data->GID2_Len))
+#else
+if((aci_slock_sim_config.sim_gidl1[0] EQ NOT_PRESENT_8BIT) OR (aci_slock_sim_config.sim_gidl2[0] EQ NOT_PRESENT_8BIT))
+#endif
+{
+if(!personalisation)
+{
+AciSLockShrd.blocked = TRUE;
+}
+else
+{
+sim_code_present_in_me = CHECK_FAIL;
+}
+return;
+}
+else
+{
+/*
+personalisation_cp->pBody[0] -----maximum number of user codes
+personalisation_cp->pBody[1] -----num of operator codes
+personalisation_cp->pBody[2] -----Operator Code-group length (To be set during configuration)
+where length =  total number of bytes occupied by operator codes
+Code type = 0x0a ( Type identifier for normal code)
+Normal code (Including parity nibble)  -- 12 bytes  (Network code + GID1 value + GID2 value)
+Code type = 0x0b (Type identifier for range)
+Network code --------- 4 byte
+GID1 value------------4 byte
+Start GID1 ---- -------4 byte
+End GID1 -------------4 byte
+Code type = 0x0c (Type identifier for regular expression)
+Regular Expression (including NW code, GID1 value and GID2 value)  --- 14 byte
+Number of User Codes   ------- 1 byt e
+Current user code index
+(for FIFO based addition/deletion of user codes)
+(should be set to 0xff if no user codes are present)  ---- 1 byte
+User code1             ---------- 12 byte
+User code 2      ---------- 12 byte
+|
+|
+User code n (n = Max number of user codes for NS)  -- 12 byte
+*/
+/* Implements NEW Mesaure */
+aci_slock_set_me_personalisation_status( personalisation, FALSE );
+if((personalisation_cp NEQ NULL) AND ((UBYTE *)personalisation_cp->pBody NEQ NULL))
+{
+index += MAX_NUM_USERCODE_SIZE;
+num_op_codes = ((UBYTE *)personalisation_cp->pBody)[index];
+index += NUM_OPCODE_SIZE;
+index +=OPCODE_LEN_SIZE;
+/*
+* check operator defined code-groups
+*/
+for(i=0; i< num_op_codes; i++)
+{
+code_type = ((UBYTE *)personalisation_cp->pBody)[index];
+index +=CODE_TYPE_SIZE;
+if( ((code_type)&0xf0)>>4)
+{
+imsi_me[0] = 0;
+	}
+else
+	{
+	   aci_slock_decode_MEPD( (UBYTE *)personalisation_sp->pBody, &index,
+	                            NW_CODE_LEN, imsi_me );
+	}
+switch(code_type)
+{
+case NORMAL_CODE :
+cmp_result = aci_slock_check_isgidPresent( (UBYTE *)personalisation_cp->pBody,
+imsi_sim, imsi_me,
+SRV_GrpLvl2, &index );
+aci_slock_set_me_personalisation_status( personalisation,
+cmp_result );
+if (cmp_result)
+{
+return;
+}
+break;
+case INTERVAL_TYPE1 :
+cmp_result = aci_slock_compare_gid_str ( imsi_me, imsi_sim, &index,SRV_GrpLvl2);
+aci_slock_set_me_personalisation_status( personalisation, cmp_result );
+if (cmp_result)
+{
+return;
+}
+break;
+case REGULAR_EXP :
+break;
+default :
+break;
+}
+}
+num_user_codes = ((UBYTE *)personalisation_cp->pBody)[index];
+index +=NUM_USER_CODE_SIZE;
+index +=CURR_USER_CODE_INDEX_SIZE;
+/*
+* check user defined code-groups
+*/
+for(i=0; i< num_user_codes; i++)
+{
+aci_slock_decode_MEPD( (UBYTE *)personalisation_cp->pBody, &index,
+NW_CODE_LEN, imsi_me );
+cmp_result = aci_slock_check_isgidPresent( (UBYTE *)personalisation_cp->pBody,
+imsi_sim, imsi_me,
+SRV_GrpLvl2,&index );
+aci_slock_set_me_personalisation_status( personalisation,cmp_result );
+if (cmp_result)
+{
+return;
+}
+}
+}
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_SMlock
++------------------------------------------------------------------------------
+|  Description :   Check IMSI against SIM personalisation
+|
+|  Parameters  :   imsi_sim            - IMSI
+|                    personalisation   - 0-add the lock data
+|                    1-verify the existing lock data
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_check_SMlock( UBYTE* imsi_sim, UBYTE  personalisation)
+{
+UBYTE num_op_codes;
+UBYTE num_user_codes;
+UBYTE cmp_result;
+UBYTE code_type;
+UBYTE i;
+UINT16 index =0;
+UBYTE me_nw_ns_msin_msin_code_str[6+2+8+8+1];
+TRACE_FUNCTION("aci_slock_check_SMlock()");
+/*
+personalisation_sim->pBody[0] -----maximum number of user codes
+personalisation_sim->pBody[1] -----num of operator codes
+personalisation_sim->pBody[2] -----Operator Code-group length (To be set during configuration)
+where length =  total number of bytes occupied by operator codes
+Code type = 0x0a ( Type identifier for normal code)
+Normal code (Including parity nibble)  -- 8 bytes  (Network code + NS code + MSIN)
+Code type = 0x0b (Type identifier for range)
+Network code + NS code  --------- 5 byte
+Start MSIN ---- -------4 byte
+End MSIN -------------4 byte
+Code type = 0x0c (Type identifier for regular expression)
+Regular Expression (including NW code NS code and MSIN)  --- 15 byte
+Number of User Codes   ------- 1 byt e
+Current user code index
+(for FIFO based addition/deletion of user codes)
+(should be set to 0xff if no user codes are present)  ---- 1 byte
+User code1             ---------- 8 byte
+User code 2      ---------- 8 byte
+|
+|
+User code n (n = Max number of user codes for NS)  -- 8 byte
+*/
+aci_slock_set_me_personalisation_status( personalisation, FALSE );
+if((personalisation_sim NEQ NULL) AND ((UBYTE *)personalisation_sim->pBody NEQ NULL))
+{
+index += MAX_NUM_USERCODE_SIZE;
+num_op_codes =((UBYTE *) personalisation_sim->pBody)[index];
+index += NUM_OPCODE_SIZE;
+index +=OPCODE_LEN_SIZE;
+/*
+* check operator defined code-groups
+*/
+for(i=0; i< num_op_codes; i++)
+{
+code_type = ((UBYTE *)personalisation_sim->pBody)[index];
+index +=CODE_TYPE_SIZE;
+switch(code_type)
+{
+case NORMAL_CODE :
+if(aci_slock_compare_codegroup_with_MEPD( personalisation,
+&index, imsi_sim,
+NW_NS_MSIN_CODE_LEN,
+MAX_IMSI_LEN,
+(UBYTE*)personalisation_sim->pBody,FALSE))
+{
+return;
+}
+break;
+case INTERVAL_TYPE1 :
+aci_slock_decode_MEPD( (UBYTE *)personalisation_sim->pBody, &index,
+NW_NS_MSIN_MSIN_CODE_LEN,
+me_nw_ns_msin_msin_code_str );
+cmp_result = aci_slock_compare_MSINCode( me_nw_ns_msin_msin_code_str,
+imsi_sim );
+aci_slock_set_me_personalisation_status( personalisation,cmp_result );
+if ( cmp_result EQ TRUE )
+{
+/*
+* The Network subset code and MSIN code matches,
+* hence return
+*/
+return;
+}
+break;
+case REGULAR_EXP :
+break;
+default :
+break;
+}
+}
+num_user_codes = ((UBYTE *)personalisation_sim->pBody)[index];
+index +=NUM_USER_CODE_SIZE;
+index +=CURR_USER_CODE_INDEX_SIZE;
+/*
+* check user defined code-groups
+*/
+for(i=0; i< num_user_codes; i++)
+{
+/*
+* Checks whether the MSIN Code is Matching with the
+* SIM Personalisation DataBase
+*/
+if(aci_slock_compare_codegroup_with_MEPD( personalisation,
+&index, imsi_sim,
+NW_NS_MSIN_CODE_LEN,
+MAX_IMSI_LEN,
+(UBYTE*)personalisation_sim->pBody,FALSE))
+{
+return;
+}
+}
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_BNWlock
++------------------------------------------------------------------------------
+|  Description : Check IMSI against blocked network personalisation
+|
+|  Parameters  :   imsi_sim            - IMSI
+|                    personalisation   - 0-add the lock data
+|                    1-verify the existing lock data
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_check_BNWlock( UBYTE* imsi_sim, UBYTE  personalisation  )
+{
+UBYTE num_op_codes;
+UBYTE num_user_codes;
+UBYTE code_type;
+UBYTE i;
+UINT16 index =0;
+UBYTE imsi_me[MAX_IMSI_LEN+1];
+UBYTE isCodeFound;
+int   me_bnw_code_first, me_bnw_code_last, sim_bnw_code;
+TRACE_FUNCTION("aci_slock_check_NWlock()");
+/*
+personalisation_bnw->pBody[0] -----maximum number of user codes
+personalisation_bnw->pBody[1] -----num of operator codes
+personalisation_bnw->pBody[2] -----Operator Code-group length (To be set during configuration)
+where length =  total number of bytes occupied by operator codes
+Code type = 0x0a ( Type identifier for normal code)
+Normal code (Including parity nibble)  -- 4 bytes
+Code type = 0x0b (Type identifier for range)
+Start value (Including parity nibble) ---- 4 byte
+End value (Including parity nibble) -----4 byte
+Code type = 0x0c (Type identifier for regular expression)
+Regular Expression  -------------6 byte
+Number of User Codes  --- 1 byte
+Current user code index  --- 1 byte
+User code1  ------------4 byte
+*/
+/* TRACE_FUNCTION_P1("personalisation = %d",personalisation);  */
+if((personalisation_bnw NEQ NULL) AND ((UBYTE *)personalisation_bnw->pBody NEQ NULL))
+{
+index += MAX_NUM_USERCODE_SIZE;
+num_op_codes = ((UBYTE *)personalisation_bnw->pBody)[index];
+index += NUM_OPCODE_SIZE;
+index +=OPCODE_LEN_SIZE;
+/* Implements NEW Mesaure */
+aci_slock_set_me_personalisation_status( personalisation, TRUE );
+/*
+* check operator defined code-groups
+*/
+for(i=0; i< num_op_codes; i++)
+{
+code_type =((UBYTE *) personalisation_bnw->pBody)[index];
+index +=CODE_TYPE_SIZE;
+switch(code_type)
+{
+case NORMAL_CODE :
+/* Checks whether the NW Code is Matching with the
+* Network Personalisation DataBase
+*/
+if (aci_slock_compare_codegroup_with_MEPD( personalisation,
+&index, imsi_sim,
+NW_CODE_LEN,
+simShrdPrm.mnc_len+3,
+(UBYTE*)personalisation_bnw->pBody,TRUE))
+{
+		   return;
+}
+break;
+case INTERVAL_TYPE1 :
+	    /* Implements New Measure */
+aci_slock_decode_MEPD( (UBYTE *)personalisation_bnw->pBody, &index,
+NW_CODE_LEN, imsi_me );
+/* to remove trailing F (if any) from imsi_me string */
+imsi_me[simShrdPrm.mnc_len+3] = '\0';
+me_bnw_code_first = atoi((const char *)imsi_me);
+aci_slock_decode_MEPD( (UBYTE *)personalisation_bnw->pBody, &index,
+NW_CODE_LEN, imsi_me );
+imsi_me[simShrdPrm.mnc_len+3] = '\0';
+me_bnw_code_last = atoi((const char *)imsi_me);
+sim_bnw_code = aci_slock_extractCode( imsi_sim, simShrdPrm.mnc_len+3 );
+isCodeFound = (sim_bnw_code >= me_bnw_code_first ) AND
+(sim_bnw_code <= me_bnw_code_last);
+aci_slock_set_me_personalisation_status ( personalisation, !isCodeFound );
+if( isCodeFound )
+{
+return;
+}
+break;
+case REGULAR_EXP :
+break;
+default :
+break;
+}
+}
+num_user_codes = ((UBYTE *)personalisation_bnw->pBody)[index];
+index +=NUM_USER_CODE_SIZE;
+index +=CURR_USER_CODE_INDEX_SIZE;
+/*
+* check user defined code-groups
+*/
+for(i=0; i< num_user_codes; i++)
+{
+	/*
+* Checks whether the NW Code is Matching with the
+* Network Personalisation DataBase
+*/
+if(aci_slock_compare_codegroup_with_MEPD( personalisation,
+&index,imsi_sim,
+NW_CODE_LEN,
+simShrdPrm.mnc_len+3,
+(UBYTE*)personalisation_bnw->pBody,TRUE))
+{
+		return;
+}
+}
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_checkpersonalisation
++------------------------------------------------------------------------------
+|  Description :   Checks for all kinds of personalisation locks (except sp & cp : Apr 03,2005).
+|        The given IMSI will be checked against the internal personalisation data.
+|        Returns SIMLOCK_BLOCKED, if one lock was not matching the given IMSI.
+|
+|  Parameters  :   None
+|
+|  Return      : SIMLOCK_FAIL = -1,
+|         SIMLOCK_DISABLED,      No SIM lock check has to be done
+|       SIMLOCK_PERM_DISABLED,
+|       SIMLOCK_ENABLED,       A SIM lock check has to be executed
+|       SIMLOCK_BLOCKED,       The SIM is blocked, i.e. because of a (or to many) wrong PIN(s)
+|        SIMLOCK_LOCKED         The ME is locked because of wrong SIM
+|
++------------------------------------------------------------------------------
+*/
+T_SIMLOCK_STATUS aci_slock_checkpersonalisation(T_SIMLOCK_TYPE   current_lock)
+{
+T_SIMLOCK_TYPE type;
+UBYTE imsi_sim[MAX_IMSI_LEN+1];
+T_SIMLOCK_STATUS sl_status=SIMLOCK_FAIL;
+T_AUTOLOCK_STATUS al_status;
+TRACE_FUNCTION("aci_slock_checkpersonalisation()");
+psaSIM_decodeIMSI(simShrdPrm.imsi.field, simShrdPrm.imsi.c_field, (char *)imsi_sim);
+/*
+*  Test SIM
+*/
+if(memcmp(imsi_sim,mnc_mcc,5) EQ 0)
+{
+aci_slock_set_simtype(SIM_TEST);
+switch(cfg_data->TestCPHS)
+{
+case ALWAYS_ACCEPTED :
+TRACE_FUNCTION("TEST SIM: always accepted");
+return( aci_slock_check_done(SIMLOCK_ENABLED));
+case ALWAYS_REJECTED :
+TRACE_FUNCTION("TEST SIM: always rejected");
+break;
+}
+}
+/*
+*  type approval
+*/
+else if(aci_slock_sim_config.sim_read_ad_first_byte & 0x80)
+{
+TRACE_FUNCTION("sim type: Classic Test SIM (Type Approval SIM)");
+aci_slock_set_simtype(SIM_TYPEAPPROVAL);
+switch(cfg_data->TypeAprovalSIM)
+{
+case ALWAYS_ACCEPTED :
+TRACE_FUNCTION("type approval: always accepted");
+return( aci_slock_check_done(SIMLOCK_ENABLED));
+/* break is removed ,as case is returning before break so it is not needed */
+case ALWAYS_REJECTED :
+TRACE_FUNCTION("type approval: always rejected");
+for (type=SIMLOCK_NETWORK; type<=SIMLOCK_SIM; type++)
+{
+if(AciSLockShrd.status[type] EQ SIMLOCK_ENABLED)
+{
+sl_status = SIMLOCK_BLOCKED;
+AciSLockShrd.blocked = TRUE;
+break;
+}
+}
+if(AciSLockShrd.blocked NEQ TRUE)
+{
+sl_status = SIMLOCK_ENABLED ;
+}
+return(aci_slock_check_done(sl_status));
+	   /* break is removed ,as case is returning before break so it is not needed */
+case UNTIL_NORMAL_SIM :
+if(AciSLockShrd.status[SIMLOCK_FIRST_SIM] EQ SIMLOCK_ENABLED) /*11_Apr_05*/
+{
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+break;
+}
+}
+/*
+*Normal SIM
+*/
+else
+{
+TRACE_FUNCTION("sim type: NORMAL SIM");
+aci_slock_set_simtype(SIM_NORMAL );
+}
+#if 0//OMAPS00134957 & ASTec32151
+if((cfg_data->FC_Current < cfg_data->FC_Max) OR (cfg_data->FC_Max EQ FC_MAX_INFINITE))
+{
+if((aci_slock_sim_config.sim_type EQ SIM_NORMAL) AND (personalisation_first_sim NEQ NULL)
+AND (AciSLockShrd.status[SIMLOCK_FIRST_SIM] EQ SIMLOCK_DISABLED) )
+{
+TRACE_FUNCTION("personalisation_first_sim NEQ NULL");
+al_status =  aci_ext_auto_personalise(current_lock);
+switch(al_status)
+{
+case AUTOLOCK_CMPL :
+return (aci_slock_check_done(SIMLOCK_ENABLED));
+case AUTOLOCK_EXCT:
+return SIMLOCK_WAIT;  /* wait for gid1 andgid2 read cnf*/
+		case AUTOLOCK_FAIL:
+default :
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+}
+else
+{
+for (type=current_lock; type<SIMLOCK_LAST; type++)
+{
+AciSLockShrd.current_lock=type;
+if (AciSLockShrd.status[type] EQ SIMLOCK_ENABLED) /* initialised in aci_slock_init */
+{
+switch (type)
+{
+case SIMLOCK_NETWORK:          aci_slock_check_NWlock(imsi_sim, 0); break;
+case SIMLOCK_NETWORK_SUBSET:   aci_slock_check_NSlock(imsi_sim, 0); break;
+case SIMLOCK_SERVICE_PROVIDER:
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl1) )
+{
+if(aci_slock_sim_config.sim_read_gid1 EQ FALSE)
+{
+aci_slock_sim_read_sim(SIM_GID1, NOT_PRESENT_8BIT, MAX_GID);
+return SIMLOCK_WAIT;
+}
+}
+else
+{
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+aci_slock_check_SPlock(imsi_sim, 0);
+	      break;
+case SIMLOCK_CORPORATE:
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl1))
+{
+if(aci_slock_sim_config.sim_read_gid1 EQ FALSE)
+	{
+aci_slock_sim_read_sim(SIM_GID1, NOT_PRESENT_8BIT, MAX_GID);
+return SIMLOCK_WAIT;
+	}
+}
+else
+{
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl2))
+{
+if(aci_slock_sim_config.sim_read_gid2 EQ FALSE)
+	{
+aci_slock_sim_read_sim(SIM_GID2, NOT_PRESENT_8BIT, MAX_GID);
+return SIMLOCK_WAIT;
+	}
+}
+else
+{
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+aci_slock_check_CPlock(imsi_sim, 0);
+	      break;
+case SIMLOCK_SIM:              aci_slock_check_SMlock(imsi_sim, 0); break;
+case SIMLOCK_FIRST_SIM:              break;
+case SIMLOCK_BLOCKED_NETWORK:          aci_slock_check_BNWlock(imsi_sim, 0); break;
+default:                       return (aci_slock_check_done(SIMLOCK_FAIL)); /* won't happen */
+}
+}
+if (AciSLockShrd.blocked)       /* if one lock isn't matching, don't try the others */
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+return (aci_slock_check_done(SIMLOCK_ENABLED));
+}
+}
+else
+{
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+#else
+{
+if((aci_slock_sim_config.sim_type EQ SIM_NORMAL) AND (personalisation_first_sim NEQ NULL)
+AND (AciSLockShrd.status[SIMLOCK_FIRST_SIM] EQ SIMLOCK_DISABLED) )
+{
+TRACE_FUNCTION("personalisation_first_sim NEQ NULL");
+al_status =  aci_ext_auto_personalise(current_lock);
+switch(al_status)
+{
+case AUTOLOCK_CMPL :
+return(aci_slock_check_done(SIMLOCK_ENABLED));
+case AUTOLOCK_EXCT:
+return SIMLOCK_WAIT;  /* wait for gid1 andgid2 read cnf*/
+case AUTOLOCK_FAIL:
+default :
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+}
+else
+{
+for (type=current_lock; type<=SIMLOCK_CORPORATE; type++)
+{
+AciSLockShrd.current_lock=type;
+if (AciSLockShrd.status[type] EQ SIMLOCK_ENABLED) /* initialised in aci_slock_init */
+{
+switch (type)
+{
+case SIMLOCK_NETWORK:          aci_slock_check_NWlock(imsi_sim, 0); break;
+case SIMLOCK_NETWORK_SUBSET:   aci_slock_check_NSlock(imsi_sim, 0); break;
+case SIMLOCK_SERVICE_PROVIDER:
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl1) )
+{
+if(aci_slock_sim_config.sim_read_gid1 EQ FALSE)
+{
+aci_slock_sim_read_sim(SIM_GID1, NOT_PRESENT_8BIT, MAX_GID);
+return SIMLOCK_WAIT;
+}
+}
+else
+{
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+aci_slock_check_SPlock(imsi_sim, 0);
+break;
+case SIMLOCK_CORPORATE:
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl1))
+{
+if(aci_slock_sim_config.sim_read_gid1 EQ FALSE)
+{
+aci_slock_sim_read_sim(SIM_GID1, NOT_PRESENT_8BIT, MAX_GID);
+return SIMLOCK_WAIT;
+}
+}
+else
+{
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl2))
+{
+if(aci_slock_sim_config.sim_read_gid2 EQ FALSE)
+{
+aci_slock_sim_read_sim(SIM_GID2, NOT_PRESENT_8BIT, MAX_GID);
+return SIMLOCK_WAIT;
+}
+}
+else
+{
+AciSLockShrd.blocked = TRUE;
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+aci_slock_check_CPlock(imsi_sim, 0);
+break;
+case SIMLOCK_SIM:              aci_slock_check_SMlock(imsi_sim, 0); break;
+default:                       return (aci_slock_check_done(SIMLOCK_FAIL)); /* won't happen */
+}
+}
+if (AciSLockShrd.blocked)       /* if one lock isn't matching, don't try the others */
+return (aci_slock_check_done(SIMLOCK_BLOCKED));
+}
+return (aci_slock_check_done(SIMLOCK_ENABLED));
+}
+}
+#endif
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_sim_init
++------------------------------------------------------------------------------
+|  Description :   Install information found in the primitive into configuration buffers
+|
+|  Parameters  :   sim_mmi_insert_ind- pointer to  T_SIM_MMI_INSERT_IND
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_sim_init ( T_SIM_MMI_INSERT_IND *sim_mmi_insert_ind )
+{
+TRACE_FUNCTION("aci_slock_sim_init()");
+aci_slock_sim_config.oper_mode = sim_mmi_insert_ind->func;
+memcpy(aci_slock_sim_service_table,sim_mmi_insert_ind->sim_serv,sizeof(aci_slock_sim_service_table));
+aci_slock_sim_config.phase = sim_mmi_insert_ind->phase;
+aci_slock_sim_config.access_acm = sim_mmi_insert_ind->access_acm;
+aci_slock_sim_config.access_acmmax = sim_mmi_insert_ind->access_acmmax;
+aci_slock_sim_config.access_puct = sim_mmi_insert_ind->access_puct;
+aci_slock_reset();
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_sim_read_sim_cb
++------------------------------------------------------------------------------
+|  Description :   Call back for SIM read.
+|  Parameters  :   table_id-
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_sim_read_sim_cb(SHORT table_id)
+{
+TRACE_FUNCTION ("aci_slock_sim_read_sim_cb()");
+simShrdPrm.atb[table_id].ntryUsdFlg = FALSE;
+/* Implements Measure 84 */
+aci_slock_sim_gid_cnf( table_id );
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_sim_read_sim
++------------------------------------------------------------------------------
+|  Description :    Request to read SIM card.
+|  Parameters  :   data_id    - data field identifier
+|        len      - actual length of data
+|        max_length  - max length of data
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_sim_read_sim(USHORT data_id, UBYTE len, UBYTE max_length)
+{
+SHORT table_id;
+TRACE_FUNCTION ("aci_slock_sim_read_sim()");
+table_id = psaSIM_atbNewEntry();
+if(table_id NEQ NO_ENTRY)
+{
+simShrdPrm.atb[table_id].ntryUsdFlg = TRUE;
+simShrdPrm.atb[table_id].accType    = ACT_RD_DAT;
+/* Called only for GID1/GID2, standard files. Hence full path not required. */
+simShrdPrm.atb[table_id].v_path_info = FALSE;
+simShrdPrm.atb[table_id].reqDataFld = data_id;
+simShrdPrm.atb[table_id].dataOff    = 0;
+simShrdPrm.atb[table_id].dataLen    = len;
+simShrdPrm.atb[table_id].recMax     = max_length;
+simShrdPrm.atb[table_id].exchData   = NULL;
+simShrdPrm.atb[table_id].rplyCB     = aci_slock_sim_read_sim_cb;
+simShrdPrm.aId = table_id;
+if(psaSIM_AccessSIMData() < 0)
+{
+TRACE_FUNCTION("abc FATAL ERROR");
+}
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_set_simtype
++------------------------------------------------------------------------------
+|  Description :    Setting the sim_type value (Normal, Test SIM, Type Approval SIM
+|  Parameters  :   sim_type    -   SIM_NORMAL =0,
+|                   SIM_TYPEAPPROVAL,
+|                   SIM_TEST
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_set_simtype(T_SIM_TYPE sim_type )
+{
+aci_slock_sim_config.sim_type = sim_type;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_set_CFG
++------------------------------------------------------------------------------
+|  Description :    To set global variable for configuration data ( part1 of Security Driver)
+|  Parameters  :   none
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+BOOL aci_slock_set_CFG(void)
+{
+T_SEC_DRV_RETURN status ;
+TRACE_FUNCTION("aci_slock_set_CFG()");
+status = sec_get_CFG(&cfg_data);
+if(status NEQ SEC_DRV_RET_Ok)
+{
+cfg_data = NULL;
+return FALSE;
+}
+return TRUE;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_set_cme_error
++------------------------------------------------------------------------------
+|  Description :   Set the cme error using ACI_ERR_DESC
+|  Parameters  :   slocktype - lock type
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_set_cme_error(T_SIMLOCK_TYPE slocktype)
+{
+int index = (cfg_data->FC_Current < cfg_data->FC_Max)?1:0;
+if(slocktype EQ  SIMLOCK_BLOCKED_NETWORK)
+{
+ACI_ERR_DESC( ACI_ERR_CLASS_Ext,
+set_cme_error_code[slocktype][index] );
+}
+else
+{
+if ( (slocktype >= SIMLOCK_NETWORK) AND
+(slocktype < SIMLOCK_LAST) )
+{
+ACI_ERR_DESC( ACI_ERR_CLASS_Cme,
+set_cme_error_code[slocktype][index] );
+}
+else
+{
+ACI_ERR_DESC( ACI_ERR_CLASS_Cme, CME_ERR_WrongPasswd );
+}
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_set_cme_error_code
++------------------------------------------------------------------------------
+|  Description :   Set the cme error code
+|  Parameters  :   err_code - cme error code
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_set_cme_error_code(T_SIMLOCK_TYPE current_lock ,T_ACI_CME_ERR *err_code)
+{
+int index = (cfg_data->FC_Current < cfg_data->FC_Max)?1:0;
+if ( (current_lock >= SIMLOCK_NETWORK) AND
+(current_lock < SIMLOCK_LAST)  AND (current_lock NEQ SIMLOCK_BLOCKED_NETWORK))
+{
+*err_code =
+(T_ACI_CME_ERR) set_cme_error_code[current_lock][index];
+}
+else
+{
+*err_code = CME_ERR_Unknown;
+aci_set_cme_error(current_lock);
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_set_cpin_code
++------------------------------------------------------------------------------
+|  Description :   Set the cpin request code
+|  Parameters  :  code - cpin request code
+|
+|  Return      : void
+|                    code -Set the cpin request code
+|
++------------------------------------------------------------------------------
+*/
+void aci_set_cpin_code(T_SIMLOCK_TYPE current_lock ,T_ACI_CPIN_RSLT *code)
+{
+int index = (cfg_data->FC_Current < cfg_data->FC_Max)?1:0;
+if ( (current_lock >= SIMLOCK_NETWORK) AND
+		(current_lock < SIMLOCK_LAST) )
+{
+	 *code =
+	 (T_ACI_CPIN_RSLT) aci_set_cpin_response[current_lock][index];
+}
+else
+{
+	 *code = CPIN_RSLT_NotPresent;
+	 ACI_ERR_DESC( ACI_ERR_CLASS_Ext, EXT_ERR_DataCorrupt );
+}
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_reset
++------------------------------------------------------------------------------
+|  Description :   Reset the lock
+|  Parameters  :  None
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_reset()
+{
+aci_slock_sim_config.sim_gidl1[0] = NOT_PRESENT_8BIT;
+aci_slock_sim_config.sim_gidl2[0] = NOT_PRESENT_8BIT;
+aci_slock_sim_config.sim_read_gid1= FALSE;
+aci_slock_sim_config.sim_read_gid2= FALSE;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_done
++------------------------------------------------------------------------------
+|  Description :   Check for lock
+|  Parameters  :  Status
+|
+|  Return      : SIMLOCK_FAIL = -1,
+|                SIMLOCK_DISABLED,
+|                SIMLOCK_PERM_DISABLED,
+|                SIMLOCK_ENABLED,
+|                SIMLOCK_BLOCKED,
+|                SIMLOCK_LOCKED,
+|                SIMLOCK_WAIT,
+|                SIMLOCK_BUSY
+|
++------------------------------------------------------------------------------
+*/
+T_SIMLOCK_STATUS aci_slock_check_done(T_SIMLOCK_STATUS sl_status)
+{
+USHORT cmdBuf = simEntStat.curCmd;
+T_ACI_CME_ERR err_code = CME_ERR_NotPresent; /* code holding the correct error code calculated */
+TRACE_FUNCTION_P1 ("aci_slock_check_done() %d",simEntStat.curCmd );
+switch(cmdBuf )
+{
+case( AT_CMD_CFUN ):
+case( AT_CMD_CPIN ):
+case( AT_CMD_PVRF ):
+case(AT_CMD_NRG) :
+case( AT_CMD_SIMRST):
+case( AT_CMD_NONE ):
+case (AT_CMD_CIMI):
+case( KSD_CMD_UBLK):
+/*
+* Start to build phonebook
+*/
+AciSLockShrd.pb_load = TRUE;
+#ifdef TI_PS_FFS_PHB
+if(last_sim_mmi_insert_ind NEQ NULL)
+{
+pb_reset();
+pb_inserted_sim (MAX_SRV_TBL,
+last_sim_mmi_insert_ind->sim_serv,
+&last_sim_mmi_insert_ind->imsi_field,
+last_sim_mmi_insert_ind->func,
+last_sim_mmi_insert_ind->phase);
+}
+#else
+if(last_sim_mmi_insert_ind NEQ NULL)
+{
+pb_reset();
+pb_build_req(last_sim_mmi_insert_ind);
+}
+#endif
+/* Request the Customer Service Profile  from the SIM (EF_CPHS_CSP) */
+cmhSIM_Get_CSP();
+if(last_sim_mmi_insert_ind  NEQ NULL)
+{
+#ifdef SIM_TOOLKIT
+cmhSMS_ReadCbDtaDwnl (last_sim_mmi_insert_ind);
+#endif
+#ifdef FF_MMI_RIV
+rAT_PlusCFUNP (last_sim_mmi_insert_ind);
+#endif /* FF_MMI_RIV */
+PFREE (last_sim_mmi_insert_ind); /* 11_Apr_05 */
+last_sim_mmi_insert_ind= NULL;
+}
+cmhSIM_SIMInserted();
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+break;
+case (AT_CMD_CLCK):
+if((AciSLockShrd.check_lock  EQ SIMLOCK_CHECK_RESET_FC) OR (AciSLockShrd.check_lock  EQ SIMLOCK_CHECK_MASTER_UNLOCK))
+{
+simEntStat.curCmd = AT_CMD_NONE;
+if((sl_status EQ SIMLOCK_ENABLED) AND (AciSLockShrd.pb_load EQ FALSE))
+{
+/*
+* Start to build phonebook
+*/
+AciSLockShrd.pb_load = TRUE;
+#ifdef TI_PS_FFS_PHB
+if(last_sim_mmi_insert_ind NEQ NULL)
+{
+pb_reset();
+pb_inserted_sim (MAX_SRV_TBL,
+last_sim_mmi_insert_ind->sim_serv,
+&last_sim_mmi_insert_ind->imsi_field,
+last_sim_mmi_insert_ind->func,
+last_sim_mmi_insert_ind->phase);
+}
+#else
+if(last_sim_mmi_insert_ind NEQ NULL)
+{
+pb_reset();
+pb_build_req(last_sim_mmi_insert_ind);
+}
+#endif
+/* Request the Customer Service Profile  from the SIM (EF_CPHS_CSP) */
+cmhSIM_Get_CSP();
+if(last_sim_mmi_insert_ind NEQ NULL)
+{
+#ifdef SIM_TOOLKIT
+cmhSMS_ReadCbDtaDwnl (last_sim_mmi_insert_ind);
+#endif
+#ifdef FF_MMI_RIV
+rAT_PlusCFUNP (last_sim_mmi_insert_ind);
+#endif /* FF_MMI_RIV */
+PFREE (last_sim_mmi_insert_ind); /* 11_Apr_05 */
+last_sim_mmi_insert_ind= NULL;
+}
+R_AT( RAT_OK, simEntStat.entOwn ) ((T_ACI_AT_CMD) cmdBuf );
+cmh_logRslt ( simEntStat.entOwn, RAT_OK, (T_ACI_AT_CMD)cmdBuf, -1, BS_SPEED_NotPresent, CME_ERR_NotPresent );
+}
+if ( AciSLockShrd.blocked)
+{
+aci_set_cme_error(AciSLockShrd.current_lock);
+/* @GBR: Alternativly CME_ERR_SimWrong might be returned, but this way is telling the MMI mor specific, what went wrong. */
+aci_set_cme_error_code_and_logRslt( cmdBuf );
+}
+aci_ext_personalisation_free();
+MFREE(cfg_data);
+}
+else if(AciSLockShrd.check_lock  EQ SIMLOCK_CHECK_LOCK)
+{
+switch(sl_status)
+{
+case SIMLOCK_ENABLED :
+simEntStat.curCmd = AT_CMD_NONE;
+R_AT( RAT_OK, simEntStat.entOwn ) ( (T_ACI_AT_CMD)cmdBuf );
+cmh_logRslt ( simEntStat.entOwn, RAT_OK, (T_ACI_AT_CMD)cmdBuf, -1, BS_SPEED_NotPresent, CME_ERR_NotPresent );
+break;
+case SIMLOCK_WAIT :
+break;
+case SIMLOCK_FAIL :
+simEntStat.curCmd = AT_CMD_NONE;
+err_code =CME_ERR_WrongPasswd;
+R_AT( RAT_CME, simEntStat.entOwn )
+( (T_ACI_AT_CMD)cmdBuf, err_code );
+cmh_logRslt ( simEntStat.entOwn, RAT_CME, (T_ACI_AT_CMD)cmdBuf, -1, BS_SPEED_NotPresent, err_code );
+break;
+}
+}
+break;
+}
+return sl_status;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_master_unlock
++------------------------------------------------------------------------------
+|  Description :   Unlock the master key
+|  Parameters  :   Masterkey password
+|
+|  Return      :  OPER_FAIL = -1,
+|                 OPER_SUCCESS,
+|                 OPER_WRONG_PASSWORD,
+|                 OPER_BUSY,
+|                 OPER_NOT_ALLOWED
+|
++------------------------------------------------------------------------------
+*/
+T_OPER_RET_STATUS aci_slock_master_unlock(char *masterkey)
+{
+T_OPER_RET_STATUS ret;
+ret = aci_ext_slock_master_unlock(masterkey);
+if(ret EQ OPER_SUCCESS)
+{
+if((aci_slock_is_timer_support() EQ TRUE) AND (aci_slock_check_timer() EQ TIMER_RUNNING)
+AND (masterkey NEQ NULL))
+{
+aci_slock_unlock_timer_stopped();
+}
+}
+return ret;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_start_timer
++------------------------------------------------------------------------------
+|  Description :   Start the penalty Timer
+|  Parameters  : None
+|
+|  Return      : Void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_start_timer(void)
+{
+TRACE_FUNCTION("aci_slock_start_timer()");
+if(aci_slock_is_timer_support() EQ TRUE)
+{
+if(!aci_slock_set_CFG())
+{
+return ;
+}
+if(cfg_data->FC_Current  NEQ 0xFF)
+{
+TIMERSTART((ACI_UNLOCK_TIMER*cfg_data->FC_Current),ACI_UNLOCK_TIMER_HANDLE);
+aci_slock_set_timer_flag(TIMER_RUNNING);
+}
+MFREE(cfg_data);
+}
+return;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_timer
++------------------------------------------------------------------------------
+|  Description :   Check for time active or not
+|  Parameters  :   None
+|
+|  Return      :  timer status
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL  UBYTE aci_slock_check_timer(void)
+{
+return (aci_ext_check_timer());
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_unlock_timer_stopped
++------------------------------------------------------------------------------
+|  Description :   Check for time is stoped or not
+|  Parameters  :   None
+|
+|  Return      :  void
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void aci_slock_unlock_timer_stopped(void)
+{
+aci_slock_set_timer_flag(TIMER_STOPPED);
+return;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_set_timer_flag
++------------------------------------------------------------------------------
+|  Description :   Set the timer flag
+|  Parameters  :   Status
+|
+|  Return      :  void
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL void aci_slock_set_timer_flag(UBYTE status)
+{
+aci_ext_set_timer_flag(status);
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_is_timer_support
++------------------------------------------------------------------------------
+|  Description :   Check the timer ,is support or not
+|  Parameters  :   None
+|
+|  Return      :   Status of timer
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL UBYTE aci_slock_is_timer_support()
+{
+UBYTE result;
+if(!aci_slock_set_CFG())
+{
+return FALSE;
+}
+result = aci_ext_is_timer_support() ;
+MFREE(cfg_data);
+return result;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_send_RAT
++------------------------------------------------------------------------------
+|  Description :   Send RAT_CME message to MMI
+|  Parameters  :   cmdBuf  - Current AT command
+|                          err_code - CME error code
+|  Return      :   none
+|
++------------------------------------------------------------------------------
+*/
+GLOBAL  void aci_slock_send_RAT(UBYTE cmdBuf,T_ACI_CME_ERR err_code )
+{
+R_AT( RAT_CME, simEntStat.entOwn )
+( (T_ACI_AT_CMD)cmdBuf, err_code );
+cmh_logRslt ( simEntStat.entOwn, RAT_CME, (T_ACI_AT_CMD)cmdBuf, -1,
+BS_SPEED_NotPresent, err_code );
+}
+/*
++------------------------------------------------------------------------------
+|
+|  Function    : aci_slock_sim_gid_cnf
++------------------------------------------------------------------------------
+|  Description : read SIM group identifier 1 or 2 from SIM card
+|
+|  Parameters  : table_id -
+|
+|  Return      : void
+|
++------------------------------------------------------------------------------
+*/
+void aci_slock_sim_gid_cnf( SHORT table_id )
+{
+T_SIMLOCK_STATUS sl_status;
+TRACE_FUNCTION( "aci_slock_sim_gid_cnf()" );
+if ( simShrdPrm.atb[table_id].errCode EQ SIM_NO_ERROR )
+{
+if(simShrdPrm.atb[table_id].reqDataFld EQ SIM_GID1)
+{
+/* The length needs to be modfied when there is no ERROR from SIM */
+aci_slock_sim_config.gid1_len = simShrdPrm.atb[table_id].dataLen;
+aci_slock_sim_config.sim_read_gid1 = TRUE;
+memcpy( aci_slock_sim_config.sim_gidl1,
+simShrdPrm.atb[table_id].exchData, MAX_GID );
+}
+else /*SIM_GID2*/
+{
+/* The length needs to be modfied when there is no ERROR from SIM */
+aci_slock_sim_config.gid2_len= simShrdPrm.atb[table_id].dataLen;
+aci_slock_sim_config.sim_read_gid2 = TRUE;
+memcpy( aci_slock_sim_config.sim_gidl2,
+simShrdPrm.atb[table_id].exchData, MAX_GID );
+}
+if( simEntStat.curCmd NEQ AT_CMD_NONE )
+{
+if( AciSLockShrd.check_lock EQ SIMLOCK_CHECK_LOCK )
+{
+sl_status = aci_slock_lock( AciSLockShrd.lock_type,
+AciSLockShrd.lock_passwd );
+aci_slock_check_done( sl_status );
+}
+else
+{
+/*
+* Since AciSLockShrd.check_lock can have only 3 values , hence there
+* is no need to put
+* else if( (AciSLockShrd.check_lock EQ SIMLOCK_CHECK_PERS) OR
+(AciSLockShrd.check_lock EQ SIMLOCK_CHECK_RESET_FC) )
+*/
+/* check for SP and corporate personalisation.
+This is the first case, we can do this,
+as we have the gid1/gid2 file here */
+sl_status= aci_slock_checkpersonalisation(AciSLockShrd.current_lock);
+}
+}
+}
+}
+/* Implements Measure  82 */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_compare_codegroup_with_MEPD
++------------------------------------------------------------------------------
+|  Description : This function compares the different code group present in SIM
+|                with the code group present in the different category of
+|                MEPD DataBase
+|
+|                This function first extracts the code group present in the
+|                different category of MEPD DataBase from the argument passed
+|                as pBody and then compares with the code group present in
+|                the SIM which is passed as an argument imsi_sim.
+|
+|                If matches returns TRUE otherwise FALSE.
+|
+|  Parameters  : personalisation - 0- add the lock data
+|                index           - array index
+|                num_user_codes  - No. of user codes
+|                imsi_sim        - IMSI
+|                code_len        - length
+|                pBody           - Different Category of Personalisation Data.
+|
+|  Return      : BOOL - if the IMSI matches returns TRUE otherwise FASLE
++------------------------------------------------------------------------------
+*/
+LOCAL BOOL aci_slock_compare_codegroup_with_MEPD( UBYTE personalisation,
+UINT16 *index,
+UBYTE *imsi_sim,
+UBYTE code_len,
+UBYTE len,
+UBYTE *pBody, BOOL bnw_flag )
+{
+UBYTE imsi_me[MAX_IMSI_LEN+1];
+BOOL isCodeFound;
+TRACE_FUNCTION( "aci_slock_compare_codegroup_with_MEPD()" );
+aci_slock_decode_MEPD( pBody, index, code_len, imsi_me );
+isCodeFound = memcmp( imsi_sim, imsi_me, len ) EQ 0;
+if(bnw_flag)
+{
+aci_slock_set_me_personalisation_status ( personalisation, !isCodeFound );
+}
+else
+{
+aci_slock_set_me_personalisation_status ( personalisation, isCodeFound );
+}
+if (isCodeFound)
+{
+return TRUE;
+}
+return FALSE;
+}
+/* Implements Measure  26 */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_set_cme_error_code_and_logRslt
++------------------------------------------------------------------------------
+|  Description : Sets the cme error code and logs the result code
+|
+|  Parameters  : cmdBuf -  Current Command
+|
+|  Return      : void
++------------------------------------------------------------------------------
+*/
+GLOBAL void aci_set_cme_error_code_and_logRslt( UBYTE cmdBuf )
+{
+T_ACI_CME_ERR err_code;
+TRACE_FUNCTION( "aci_set_cme_error_code_and_logRslt()" );
+aci_set_cme_error_code( AciSLockShrd.current_lock, &err_code );
+aci_slock_send_RAT(cmdBuf, err_code );
+}
+/* Implements NEW Measure */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_compare_NSCode
++------------------------------------------------------------------------------
+|  Description : This function will compare the network subset code present
+|                in SIM with the network subset code which is present in MEPD
+|                DataBase
+|
+|                IF the comparison matches the function will return TRUE,
+|                otherwise FALSE
+|
+|  Parameters  : me_nw_code        - Network Code from MEPD DataBase
+|                me_nw_ns_code_str - Network Subset Code String from
+|                                    MEPD DataBase.
+|
+|                imsi_sim          - IMSI from SIM
+|
+|  Return      : BOOL - Returns the Result of the comparison
++------------------------------------------------------------------------------
+*/
+LOCAL UBYTE aci_slock_compare_NSCode ( UBYTE *me_nw_code,
+UBYTE *me_nw_ns_code_str,
+UBYTE *imsi_sim )
+{
+int me_ns_code_first, me_ns_code_last, sim_ns_code;
+BOOL cmp_result;
+TRACE_FUNCTION( "aci_slock_compare_NSCode()" );
+cmp_result = memcmp( imsi_sim, me_nw_code, simShrdPrm.mnc_len+3 ) EQ 0;
+if ( cmp_result EQ TRUE )
+{
+me_ns_code_first = aci_slock_extractCode( me_nw_ns_code_str+7, 2 );
+me_ns_code_last = aci_slock_extractCode( me_nw_ns_code_str+7+2, 2 );
+sim_ns_code = aci_slock_extractCode( imsi_sim+simShrdPrm.mnc_len+3, 2 );
+if((sim_ns_code >= me_ns_code_first ) AND (sim_ns_code <= me_ns_code_last))
+{
+return TRUE; /* Matches */
+}
+else
+{
+return FALSE;
+}
+}
+return ( cmp_result );
+}
+/* Implements NEW Measure */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_compare_MSINCode
++------------------------------------------------------------------------------
+|  Description : This function will compare MSIN Code from MEPD DataBase
+|                with the MSIN Code present in SIM
+|
+|                IF the comparison matches the function will return TRUE,
+|                otherwise FALSE
+|
+|  Parameters  : me_nw_ns_msin_msin_code_str  - msin Code String from
+|                                               MEPD DataBase.
+|                imsi_sim                     - IMSI from SIM
+|
+|  Return      : BOOL - Returns the Result of the comparison
++------------------------------------------------------------------------------
+*/
+LOCAL UBYTE aci_slock_compare_MSINCode( UBYTE *me_nw_ns_msin_msin_code_str,
+UBYTE *imsi_sim )
+{
+UBYTE me_nw_ns_code_str[6+2+1];
+BOOL cmp_result;
+int me_msin_code_first, me_msin_code_last, sim_msin_code;
+TRACE_FUNCTION( "aci_slock_compare_MSINCode()" );
+memcpy(me_nw_ns_code_str,me_nw_ns_msin_msin_code_str,simShrdPrm.mnc_len+3+2);
+cmp_result = memcmp( imsi_sim, me_nw_ns_code_str,
+simShrdPrm.mnc_len+3+2 ) EQ 0;
+if ( cmp_result EQ TRUE )
+{
+me_msin_code_first = aci_slock_extractCode( me_nw_ns_msin_msin_code_str+9,
+(MAX_IMSI_LEN - simShrdPrm.mnc_len+3+2) );
+me_msin_code_last = aci_slock_extractCode( me_nw_ns_msin_msin_code_str+9+8,
+(MAX_IMSI_LEN - simShrdPrm.mnc_len+3+2) );
+sim_msin_code = aci_slock_extractCode( imsi_sim+simShrdPrm.mnc_len+3+2,
+(MAX_IMSI_LEN - cfg_data->MNC_Len+3+2) );
+if( (sim_msin_code >= me_msin_code_first ) AND
+(sim_msin_code <= me_msin_code_last) )
+{
+return TRUE; /* Matches */
+}
+else
+{
+return FALSE;
+}
+}
+return ( cmp_result );
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_compare_NSCode
++------------------------------------------------------------------------------
+|  Description : This function will extract the code in Integer format
+|                from the string that has been passed as a parameter source_str
+|
+|  Parameters  : souce_str        - Source String from which the code is
+|                                   extracted out.
+|                len              - Length
+|
+|  Return      : BOOL - Returns the Code in Integer Format
++------------------------------------------------------------------------------
+*/
+LOCAL int aci_slock_extractCode( UBYTE *source_str, UBYTE len )
+{
+UBYTE dest_str[MAX_IMSI_LEN+1];
+memcpy(dest_str,source_str, len);
+dest_str[len] = '\0';
+return( atoi((const char *)dest_str));
+}
+/* Implements Measure 212 */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_isNSCodePresent
++------------------------------------------------------------------------------
+|  Description : This function is intended to compare the Network Subset Code
+|                from the Network Subset Personalisation Database and SIM.
+|
+|                First it will compare the Network Code between the
+|                Network Subset Personalisation Database and SIM.
+|
+|                IF that matches then it will compare the Network Subset Code
+|                between the Network Subset Personalisation Database and SIM.
+|
+|                If the comparison matches the function will return TRUE,
+|                otherwise FALSE
+|
+|  Parameters  : me_nw_code       - Network Subset Code from
+|                                   Network Subset Personalisation
+|                imsi_sim         - IMSI from SIM
+|                index            -
+|
+|  Return      : BOOL - Returns the Result of the comparison
++------------------------------------------------------------------------------
+*/
+LOCAL UBYTE aci_slock_check_isNSCodePresent( UBYTE *me_nw_code,
+UBYTE *imsi_sim,
+UINT16 *index )
+{
+UBYTE imsi_sim_8or9th_digit_str[1+1];
+UBYTE me_ns_code_bcd[NS_CODE_LEN];
+UBYTE me_ns_code[2 +1];
+UBYTE no_of_normal_8th_digit_ns_code;
+UBYTE digit_8th_value;
+UBYTE no_of_digit_8th_value;
+UBYTE no_of_interval_8th_digit_ns_code;
+BOOL cmp_result;
+int me_ns_code_first,
+me_ns_code_last,
+sim_ns_code,
+sim_8or9th_digit_code,
+j,k;
+TRACE_FUNCTION( "aci_slock_check_isNSCodePresent()" );
+cmp_result = memcmp(imsi_sim,me_nw_code,simShrdPrm.mnc_len+3) EQ 0;
+no_of_digit_8th_value = ((UBYTE *)personalisation_ns->pBody)[*index] ;
+*index += 1;
+if ( cmp_result EQ TRUE )
+{
+cmp_result = FALSE;
+imsi_sim_8or9th_digit_str[0] = imsi_sim[simShrdPrm.mnc_len+3+2];
+imsi_sim_8or9th_digit_str[1]  ='\0';
+sim_8or9th_digit_code = atoi((const char *)imsi_sim_8or9th_digit_str);
+for(j=0; j<no_of_digit_8th_value; j++ )
+{
+digit_8th_value = ((UBYTE *)personalisation_ns->pBody)[*index];
+*index += 1;
+no_of_normal_8th_digit_ns_code  =
+((UBYTE *)personalisation_ns->pBody)[*index];
+*index += 1;
+no_of_interval_8th_digit_ns_code  =
+((UBYTE *)personalisation_ns->pBody)[*index];
+*index += 1;
+if( sim_8or9th_digit_code EQ digit_8th_value )
+{
+for( k =0; k < no_of_normal_8th_digit_ns_code; k++ )
+{
+memcpy( me_ns_code_bcd, &(((UBYTE *)personalisation_ns->pBody)[*index]),
+NS_CODE_LEN );
+*index += NS_CODE_LEN;
+aci_slock_psaSIM_decodeIMSI_without_parity( me_ns_code_bcd,
+NS_CODE_LEN,
+(char *)me_ns_code);
+cmp_result = memcmp( imsi_sim + simShrdPrm.mnc_len+3,
+me_ns_code, 2 ) EQ 0;
+if( cmp_result EQ TRUE )
+{
+return TRUE; /* Matches */
+}
+}
+if( cmp_result EQ FALSE )
+{
+for(k =0; k < no_of_interval_8th_digit_ns_code; k++)
+{
+memcpy( me_ns_code_bcd,
+&(((UBYTE *)personalisation_ns->pBody)[*index]),NS_CODE_LEN);
+*index += NS_CODE_LEN;
+aci_slock_psaSIM_decodeIMSI_without_parity( me_ns_code_bcd,
+NS_CODE_LEN,
+(char *)me_ns_code );
+me_ns_code[2] = '\0';
+me_ns_code_first =  atoi((const char *)me_ns_code);
+memcpy( me_ns_code_bcd,
+&(((UBYTE *)personalisation_ns->pBody)[*index]),
+NS_CODE_LEN );
+*index += NS_CODE_LEN;
+aci_slock_psaSIM_decodeIMSI_without_parity( me_ns_code_bcd,
+NS_CODE_LEN,
+(char *)me_ns_code );
+me_ns_code[2] = '\0';
+me_ns_code_last =  atoi((const char *)me_ns_code);
+sim_ns_code =
+aci_slock_extractCode( &imsi_sim[simShrdPrm.mnc_len+3], 2 );
+if( ( sim_ns_code >= me_ns_code_first ) AND
+( sim_ns_code <= me_ns_code_last ) )
+{
+return TRUE; /* Matches */
+}
+else
+{
+return FALSE;
+}
+}
+}
+else
+{
+*index += ( NS_CODE_LEN*no_of_normal_8th_digit_ns_code +
+2*NS_CODE_LEN*no_of_interval_8th_digit_ns_code ) ;
+}
+}
+}
+}
+return FALSE;
+}
+/* Implements Measure 146 */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_compare_gid_str
++------------------------------------------------------------------------------
+|  Description : This function will compare the gid str present in the SIM
+|                and the gid str present in the MEPD Database.
+|
+|                This function can compare both the gid str i.e for
+|                Group Identifier Level 1 and Group Identifier Level 2.
+|                depending upon the Group Identifier Level passed as an
+|                argument grp_lvl.
+|
+|
+|  Parameters  : imsi_me  - IMSI from Personalisation DataBase
+|                imsi_sim - IMSI from SIM
+|                index    -
+|                grp_lvl  -  Group Identifier Level 1 or
+|                            Group Identifier Level 2
+|
+|  Return      : BOOL - Returns the Result of the comparison
++------------------------------------------------------------------------------
+*/
+LOCAL UBYTE aci_slock_compare_gid_str( UBYTE *imsi_me,
+UBYTE *imsi_sim,
+UINT16 *index,
+T_SIM_SRV grp_lvl)
+{
+UBYTE cmp_result = TRUE;
+UBYTE me_gid1_str[GID1_LEN+1];
+UBYTE me_gid2_str[GID2_LEN+1];
+UBYTE sim_gid1_str[GID1_LEN+1];
+UBYTE sim_gid2_str[GID2_LEN+1];
+TRACE_FUNCTION( "aci_slock_compare_gid_str()" );
+if(imsi_me[0] NEQ 0)
+{
+cmp_result = memcmp( imsi_sim, imsi_me,simShrdPrm.mnc_len+3 ) EQ 0;
+}
+if ( cmp_result EQ TRUE )
+{
+if ( psaSIM_ChkSIMSrvSup(SRV_GrpLvl1) )
+{
+if( grp_lvl EQ SRV_GrpLvl1 )
+{
+return ( aci_slock_compare_gid( me_gid1_str,
+aci_slock_sim_config.sim_gidl1,
+sim_gid1_str, GID1_LEN,
+(UBYTE *)personalisation_sp->pBody,
+index ) );
+}
+else
+{
+memcpy( me_gid1_str,&(((UBYTE *)personalisation_cp->pBody)[*index]),
+GID1_LEN);
+*index +=GID1_LEN;
+cmp_result = memcmp( aci_slock_sim_config.sim_gidl1, me_gid1_str,
+cfg_data->GID1_Len ) EQ 0;
+if ( cmp_result EQ TRUE )
+{
+if ( psaSIM_ChkSIMSrvSup(SRV_GrpLvl2) )
+{
+return ( aci_slock_compare_gid( me_gid2_str,
+aci_slock_sim_config.sim_gidl2,
+sim_gid2_str, GID2_LEN,
+(UBYTE *)personalisation_cp->pBody,
+index ) );
+}
+}
+}
+}
+}
+return FALSE;
+}
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_compare_gid
++------------------------------------------------------------------------------
+|  Description : This function will compare gid str of SIM and the MEPD
+|                DataBase and returns TRUE if it matches otherwise FALSE
+|
+|
+|  Parameters  : me_gid_str  -
+|                sim_gidl    - gid string from aci_slock_sim_config
+|                sim_gid_str -
+|                gid_len     - gid length
+|                pBody       - Personalisation Data
+|                index       -
+|
+|  Return      : BOOL - Returns the Result of the comparison
++------------------------------------------------------------------------------
+*/
+LOCAL UBYTE aci_slock_compare_gid( UBYTE *me_gid_str, UBYTE *sim_gidl,
+UBYTE *sim_gid_str, UBYTE gid_len,
+UBYTE *pBody, UINT16 *index )
+{
+int sim_gid, me_gid_first, me_gid_last;
+TRACE_FUNCTION( "aci_slock_compare_gid()" );
+me_gid_first = aci_slock_extractCode( &(pBody[*index]), gid_len );
+*index +=gid_len;
+me_gid_last = aci_slock_extractCode( &(pBody[*index]), gid_len );
+*index +=gid_len;
+sim_gid = aci_slock_extractCode( sim_gidl, gid_len );
+if((sim_gid >= me_gid_first) AND (sim_gid <= me_gid_last))
+{
+return TRUE; /* Matches */
+}
+else
+{
+return FALSE;
+}
+}
+/* Implements Measure 160 */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_check_isgidPresent
++------------------------------------------------------------------------------
+|  Description : This function will compare gid str of SIM and the MEPD
+|                DataBase for the NORMAL CODE type
+|                and returns TRUE if it matches otherwise FALSE
+|
+|
+|  Parameters  : pBody    - Personalisation Data
+|                imsi_sim - IMSI from SIM
+|                imsi_me  - IMSI from Personalisation DataBase
+|                grp_lvl  - Group Identifier Level 1 or
+|                           Group Identifier Level 2
+|                index    -
+|
+|  Return      : BOOL - Returns the Result of the comparison
++------------------------------------------------------------------------------
+*/
+LOCAL UBYTE aci_slock_check_isgidPresent( UBYTE *pBody, UBYTE *imsi_sim,
+UBYTE *imsi_me, T_SIM_SRV grp_lvl, UINT16 *index )
+{
+UBYTE me_gid1_str[GID1_LEN+1];
+UBYTE me_gid2_str[GID2_LEN+1];
+UBYTE cmp_result = TRUE;
+TRACE_FUNCTION( "aci_slock_check_isgidPresent()" );
+if(imsi_me[0] NEQ 0)
+{
+cmp_result = memcmp(imsi_sim,imsi_me,simShrdPrm.mnc_len+3) EQ 0;
+}
+if ( cmp_result EQ TRUE )
+{
+if ( psaSIM_ChkSIMSrvSup(SRV_GrpLvl1) )
+{
+memcpy( me_gid1_str,&(pBody[*index]), GID1_LEN );
+*index +=GID1_LEN;
+cmp_result = memcmp( aci_slock_sim_config.sim_gidl1,
+me_gid1_str, cfg_data->GID1_Len) EQ 0;
+if ( cmp_result EQ TRUE )
+{
+if( grp_lvl EQ SRV_GrpLvl2 )
+{
+if (psaSIM_ChkSIMSrvSup(SRV_GrpLvl2))
+{
+memcpy( me_gid2_str, &(pBody[*index]), GID2_LEN);
+*index +=GID2_LEN;
+cmp_result = memcmp( aci_slock_sim_config.sim_gidl2,
+me_gid2_str, cfg_data->GID2_Len ) EQ 0;
+if ( cmp_result EQ TRUE )
+{
+return TRUE;
+}
+}
+}
+else
+{
+return TRUE;
+}
+}
+}
+}
+return FALSE;
+}
+/* Implements NEW Measure */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_decode_MEPD
++------------------------------------------------------------------------------
+|  Description : This function will convert IMSI of MEPD DataBase
+|                from BCD to ASCII format.
+|
+|  Parameters  : pBody       - Personalisation Data
+|                index       -
+|                code_len    - Code Length
+|                imsi_ascii  - IMSI in ASCII Format (OutPut parameter)
+|
+|  Return      : void
++------------------------------------------------------------------------------
+*/
+LOCAL void aci_slock_decode_MEPD( UBYTE *pBody, UINT16 *index, UBYTE code_len,
+UBYTE *imsi_ascii )
+{
+UBYTE me_code_bcd[NW_NS_MSIN_MSIN_CODE_LEN];
+/*
+* NW_NS_MSIN_MSIN_CODE_LEN has been used because this is the biggest size
+* needed by the callers of the this function
+*/
+TRACE_FUNCTION( "aci_slock_decode_MEPD()" );
+memcpy( me_code_bcd, &(pBody[*index]), code_len );
+*index += code_len;
+aci_slock_psaSIM_decodeIMSI( me_code_bcd, code_len, (char *)imsi_ascii );
+}
+/* Implements NEW Measure */
+/*
++------------------------------------------------------------------------------
+|  Function    : aci_slock_set_me_personalisation_status
++------------------------------------------------------------------------------
+|  Description : This function will set the Global Flag AciSLockShrd.blocked
+|                or sim_code_present_in_me.
+|
+|  Parameters  : personalisation - Personalisation
+|                status          - TRUE or FALSE
+|
+|  Return      : void
++------------------------------------------------------------------------------
+*/
+LOCAL void aci_slock_set_me_personalisation_status( UBYTE personalisation,
+UBYTE status )
+{
+TRACE_FUNCTION( "aci_slock_set_me_personalisation_status()" );
+if( !personalisation )
+{
+AciSLockShrd.blocked = !status;
+}
+else
+{
+sim_code_present_in_me = status;
+}
+}
+#endif

FreeCalypso > hg > fc-tourmaline

comparison src/g23m-aci/aci/aci_slock.c @ 1:fa8dc04885d8