[PATCH 2/2] sim: Read EFust and EFest

--- src/sim.c | 75 +++++++++++++++++++++++++++++++++++++++- src/simutil.c | 18 ++++++++++ src/simutil.h | 105 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 196 insertions(+), 2 deletions(-) diff --git a/src/sim.c b/src/sim.c index d2ed780..235f457 100644 --- a/src/sim.c +++ b/src/sim.c @@ -95,6 +95,10 @@ struct ofono_sim { void *driver_data; struct ofono_atom *atom; DBusMessage *pending; + unsigned char *efust; + unsigned char efust_length; + unsigned char *efest; + unsigned char efest_length; }; struct msisdn_set_request { @@ -1076,6 +1080,61 @@ static void sim_retrieve_imsi(struct ofono_sim *sim) sim->driver->read_imsi(sim, sim_imsi_cb, sim); } +static void sim_efest_read_cb(int ok, int length, int record, + const unsigned char *data, + int record_length, void *userdata) +{ + struct ofono_sim *sim = userdata; + + if (!ok) + goto out; + + if (length < 1) { + ofono_error("EFest shall contain at least one byte"); + goto out; + } + + sim->efest = g_memdup(data, length); + sim->efest_length = length; + +out: + sim_retrieve_imsi(sim); +} + +static void sim_efust_read_cb(int ok, int length, int record, + const unsigned char *data, + int record_length, void *userdata) +{ + struct ofono_sim *sim = userdata; + + if (!ok) + goto out; + + if (length < 1) { + ofono_error("EFust shall contain at least one byte"); + goto out; + } + + sim->efust = g_memdup(data, length); + sim->efust_length = length; + + ofono_sim_read(sim, SIM_EFEST_FILEID, + OFONO_SIM_FILE_STRUCTURE_TRANSPARENT, + sim_efest_read_cb, sim); + + return; + +out: + sim_retrieve_imsi(sim); +} + +static inline void sim_retrieve_efust(struct ofono_sim *sim) +{ + ofono_sim_read(sim, SIM_EFUST_FILEID, + OFONO_SIM_FILE_STRUCTURE_TRANSPARENT, + sim_efust_read_cb, sim); +} + static void sim_pin_query_cb(const struct ofono_error *error, enum ofono_sim_password_type pin_type, void *data) @@ -1110,13 +1169,13 @@ static void sim_pin_query_cb(const struct ofono_error *error, checkdone: if (pin_type == OFONO_SIM_PASSWORD_NONE) - sim_retrieve_imsi(sim); + sim_retrieve_efust(sim); } static void sim_pin_check(struct ofono_sim *sim) { if (!sim->driver->query_passwd_state) { - sim_retrieve_imsi(sim); + sim_retrieve_efust(sim); return; } @@ -1934,6 +1993,18 @@ static void sim_free_state(struct ofono_sim *sim) g_strfreev(sim->language_prefs); sim->language_prefs = NULL; } + + if (sim->efust) { + g_free(sim->efust); + sim->efust = NULL; + sim->efust_length = 0; + } + + if (sim->efest) { + g_free(sim->efest); + sim->efest = NULL; + sim->efest_length = 0; + } } void ofono_sim_inserted_notify(struct ofono_sim *sim, ofono_bool_t inserted) diff --git a/src/simutil.c b/src/simutil.c index 4b49b00..2d0764c 100644 --- a/src/simutil.c +++ b/src/simutil.c @@ -1416,3 +1416,21 @@ gboolean sim_parse_2g_get_response(const unsigned char *response, int len, return TRUE; } + +gboolean sim_ust_is_available(unsigned char *efust, unsigned char len, + enum sim_ust_service index) +{ + if (index >= len * 8) + return FALSE; + + return (efust[index / 8] >> (index % 8)) & 1; +} + +gboolean sim_est_is_active(unsigned char *efest, unsigned char len, + enum sim_est_service index) +{ + if (index >= len * 8) + return FALSE; + + return (efest[index / 8] >> (index % 8)) & 1; +} diff --git a/src/simutil.h b/src/simutil.h index 29194ca..4db950b 100644 --- a/src/simutil.h +++ b/src/simutil.h @@ -26,9 +26,11 @@ enum sim_fileid { SIM_EF_CPHS_MWIS_FILEID = 0x6f11, SIM_EF_CPHS_INFORMATION_FILEID = 0x6f16, SIM_EF_CPHS_MBDN_FILEID = 0x6f17, + SIM_EFUST_FILEID = 0x6f38, SIM_EFMSISDN_FILEID = 0x6f40, SIM_EFSPN_FILEID = 0x6f46, SIM_EFSDN_FILEID = 0x6f49, + SIM_EFEST_FILEID = 0x6f56, SIM_EFAD_FILEID = 0x6fad, SIM_EFPHASE_FILEID = 0x6fae, SIM_EFPNN_FILEID = 0x6fc5, @@ -53,6 +55,104 @@ enum sim_file_access { SIM_FILE_ACCESS_NEVER = 15, }; +/* 131.102 Section 4.2.8 */ +enum sim_ust_service { + SIM_UST_SERVICE_LOCAL_PHONE_BOOK = 0, + SIM_UST_SERVICE_FDN = 1, + SIM_UST_SERVICE_EXT_2 = 2, + SIM_UST_SERVICE_SDN = 3, + SIM_UST_SERVICE_EXT_3 = 4, + SIM_UST_SERVICE_BDN = 5, + SIM_UST_SERVICE_EXT_4 = 6, + SIM_UST_SERVICE_OCI_OCT = 7, + SIM_UST_SERVICE_ICI_ICT = 8, + SIM_UST_SERVICE_SMS = 9, + SIM_UST_SERVICE_SMSR = 10, + SIM_UST_SERVICE_SMSP = 11, + SIM_UST_SERVICE_AOC = 12, + SIM_UST_SERVICE_CCP2 = 13, + SIM_UST_SERVICE_CBS_ID = 14, + SIM_UST_SERVICE_CBS_ID_RANGE = 15, + SIM_UST_SERVICE_GROUP_ID_LEVEL_1 = 16, + SIM_UST_SERVICE_GROUP_ID_LEVEL_2 = 17, + SIM_UST_SERVICE_PROVIDER_NAME = 18, + SIM_UST_SERVICE_USER_PLMN = 19, + SIM_UST_SERVICE_MSISDN = 20, + SIM_UST_SERVICE_IMG = 21, + SIM_UST_SERVICE_SOLSA = 22, + SIM_UST_SERVICE_PRECEDENCE_PREEMPTION = 23, + SIM_UST_SERVICE_EMLPP = 24, + SIM_UST_SERVICE_GSM_ACCESS = 26, + SIM_UST_SERVICE_DATA_DOWNLOAD_SMS_PP = 27, + SIM_UST_SERVICE_DATA_DOWNLOAD_SMS_CB = 28, + SIM_UST_SERVICE_CALL_CONTROL_USIM = 29, + SIM_UST_SERVICE_MO_SMS_USIM = 30, + SIM_UST_SERVICE_RUN_AT_COMMAND = 31, + SIM_UST_SERVICE_ENABLED_SERVICE_TABLE = 33, + SIM_UST_SERVICE_ACL = 34, + SIM_UST_SERVICE_DEPERSONALISATION_CTRL_KEY = 35, + SIM_UST_SERVICE_NETWORK_LIST = 36, + SIM_UST_SERVICE_GSM_SECURITY_CONTEXT = 37, + SIM_UST_SERVICE_CPBCCH = 38, + SIM_UST_SERVICE_INVESTIGATION_SCAN = 39, + SIM_UST_SERVICE_MEXE = 40, + SIM_UST_SERVICE_OPERATOR_PLMN = 41, + SIM_UST_SERVICE_HPLMN = 42, + SIM_UST_SERVICE_EXT_5 = 43, + SIM_UST_SERVICE_PLMN_NETWORK_NAME = 44, + SIM_UST_SERVICE_OPERATOR_PLMN_LIST = 45, + SIM_UST_SERVICE_MAILBOX_DIALLING_NUMBERS = 46, + SIM_UST_SERVICE_MWIS = 47, + SIM_UST_SERVICE_CFIS = 48, + SIM_UST_SERVICE_PROVIDER_DISPLAY_INFO = 50, + SIM_UST_SERVICE_MMS = 51, + SIM_UST_SERVICE_EXT_8 = 52, + SIM_UST_SERVICE_CALL_CONTROL_GPRS_USIM = 53, + SIM_UST_SERVICE_MMS_USER_CONN_PARAM = 54, + SIM_UST_SERVICE_NIA = 55, + SIM_UST_SERVICE_EFVGCS_EFVGCSS = 56, + SIM_UST_SERVICE_EFVBS_EFVBSS = 57, + SIM_UST_SERVICE_PSEUDONYM = 58, + SIM_UST_SERVICE_USER_PLMN_I_WLAN = 59, + SIM_UST_SERVICE_OPERATOR_PLMN_I_WLAN = 60, + SIM_UST_SERVICE_USER_WSID = 61, + SIM_UST_SERVICE_OPERATOR_WSID = 62, + SIM_UST_SERVICE_VGCS_SECURITY = 63, + SIM_UST_SERVICE_VBS_SECURITY = 64, + SIM_UST_SERVICE_WLAN_REAUTH_ID = 65, + SIM_UST_SERVICE_MMS_STORAGE = 66, + SIM_UST_SERVICE_GBA = 67, + SIM_UST_SERVICE_MBMS_SECURITY = 68, + SIM_UST_SERVICE_USSD_APPLICATION_MODE = 69, + SIM_UST_SERVICE_EQUIVALENT_HPLMN = 70, + SIM_UST_SERVICE_ADDITIONAL_TERMINAL_PROFILE = 71, + SIM_UST_SERVICE_EQUIVALENT_HPLMN_IND = 72, + SIM_UST_SERVICE_LAST_RPLMN_IND = 73, + SIM_UST_SERVICE_OMA_BCAST_SC_PROFILE = 74, + SIM_UST_SERVICE_BGA_LOCAL_KEY = 75, + SIM_UST_SERVICE_TERMINAL_APPLICATIONS = 76, + SIM_UST_SERVICE_PROVIDER_NAME_ICON = 77, + SIM_UST_SERVICE_PLMN_NETWORK_NAME_ICON = 78, + SIM_UST_SERVICE_CONN_PARAM_USIM_IP = 79, + SIM_UST_SERVICE_HOME_I_WLAN_ID_LIST = 80, + SIM_UST_SERVICE_I_WLAN_EQUIVALENT_HPLMN_IND = 81, + SIM_UST_SERVICE_I_WLAN_HPLMN_PRIORITY_IND = 82, + SIM_UST_SERVICE_I_WLAN_LAST_PLMN = 83, + SIM_UST_SERVICE_EPS_INFO = 84, + SIM_UST_SERVICE_CSG_IND = 85, + SIM_UST_SERVICE_CALL_CONTROL_EPS_PDN_USIM = 86, + SIM_UST_SERVICE_HPLMN_DIRECT_ACCESS = 87, + SIM_UST_SERVICE_ECALL_DATA = 88, + SIM_UST_SERVICE_OPERATOR_CSG = 89 +}; + +/* 131.102 Section 4.2.47 */ +enum sim_est_service { + SIM_EST_SERVICE_FDN = 0, + SIM_EST_SERVICE_BDN = 1, + SIM_EST_SERVICE_ACL = 2 +}; + #define SIM_EFSPN_DC_HOME_PLMN_BIT 0x1 #define SIM_EFSPN_DC_ROAMING_SPN_BIT 0x2 @@ -266,3 +366,8 @@ gboolean sim_parse_3g_get_response(const unsigned char *data, int len, gboolean sim_parse_2g_get_response(const unsigned char *response, int len, int *file_len, int *record_len, int *structure, unsigned char *access); + +gboolean sim_ust_is_available(unsigned char *service_ust, unsigned char len, + enum sim_ust_service index); +gboolean sim_est_is_active(unsigned char *service_est, unsigned char len, + enum sim_est_service index); -- 1.7.0.4