From d54c2ee8c51b41b7f7a5a469efd6bb391a0c2b75 Mon Sep 17 00:00:00 2001 From: Harald Welte Date: Tue, 17 Jan 2012 18:25:50 +0100 Subject: initial checkin of 'libosmosim' --- src/sim/Makefile.am | 16 ++ src/sim/card_fs_sim.c | 385 +++++++++++++++++++++++++++++++++++++++++++++++++ src/sim/card_fs_uicc.c | 185 ++++++++++++++++++++++++ src/sim/card_fs_usim.c | 288 ++++++++++++++++++++++++++++++++++++ src/sim/core.c | 172 ++++++++++++++++++++++ src/sim/file_codec.c | 34 +++++ src/sim/gsm_int.h | 12 ++ src/sim/reader.c | 224 ++++++++++++++++++++++++++++ src/sim/reader_pcsc.c | 133 +++++++++++++++++ src/sim/sim_int.h | 38 +++++ 10 files changed, 1487 insertions(+) create mode 100644 src/sim/Makefile.am create mode 100644 src/sim/card_fs_sim.c create mode 100644 src/sim/card_fs_uicc.c create mode 100644 src/sim/card_fs_usim.c create mode 100644 src/sim/core.c create mode 100644 src/sim/file_codec.c create mode 100644 src/sim/gsm_int.h create mode 100644 src/sim/reader.c create mode 100644 src/sim/reader_pcsc.c create mode 100644 src/sim/sim_int.h (limited to 'src/sim') diff --git a/src/sim/Makefile.am b/src/sim/Makefile.am new file mode 100644 index 00000000..f3f8069c --- /dev/null +++ b/src/sim/Makefile.am @@ -0,0 +1,16 @@ +# This is _NOT_ the library release version, it's an API version. +# Please read Chapter 6 "Library interface versions" of the libtool documentation before making any modification +LIBVERSION=0:0:0 + +INCLUDES = $(all_includes) -I$(top_srcdir)/include +AM_CFLAGS = -fPIC -Wall + +noinst_HEADERS = sim_int.h gsm_int.h + +lib_LTLIBRARIES = libosmosim.la + +libosmosim_la_SOURCES = core.c card_fs_sim.c card_fs_usim.c card_fs_uicc.c file_codec.c reader.c reader_pcsc.c +# FIXME: use autoconf to determine pcsc include path / library name +libosmosim_la_LDFLAGS = -version-info $(LIBVERSION) -lpcsclite +libosmosim_la_CFLAGS = -I/usr/include/PCSC + diff --git a/src/sim/card_fs_sim.c b/src/sim/card_fs_sim.c new file mode 100644 index 00000000..d8421505 --- /dev/null +++ b/src/sim/card_fs_sim.c @@ -0,0 +1,385 @@ + +#include +#include + +#include +#include +#include + +#include "sim_int.h" + +/* TS 11.11 / Chapter 9.4 */ +static const struct osim_card_sw ts11_11_sw[] = { + { + 0x9000, 0xffff, SW_TYPE_STR, SW_CLS_OK, + .u.str = "Normal ending of the command", + }, { + 0x9100, 0xff00, SW_TYPE_STR, SW_CLS_OK, + .u.str = "Normal ending of the command - proactive command from SIM pending", + }, { + 0x9e00, 0xff00, SW_TYPE_STR, SW_CLS_OK, + .u.str = "Normal ending of the command - response data for SIM data download", + }, { + 0x9f00, 0xff00, SW_TYPE_STR, SW_CLS_OK, + .u.str = "Normal ending of the command - response data available", + }, { + 0x9300, 0xffff, SW_TYPE_STR, SW_CLS_POSTP, + .u.str = "SIM Application Toolkit is busy, command cannot be executed at present", + }, { + 0x9200, 0xfff0, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "Memory management - Command successful but after using an internal updat retry X times", + }, { + 0x9240, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Memory management - Memory problem", + }, { + 0x9400, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Referencing management - no EF selected", + }, { + 0x9402, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Referencing management - out of range (invalid address)", + }, { + 0x9404, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Referencing management - file ID not found / pattern not found", + }, { + 0x9802, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Security management - no CHV initialized", + }, { + 0x9804, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Security management - access condition not fulfilled", + }, { + 0x9808, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Security management - in contradiction with CHV status", + }, { + 0x9810, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Security management - in contradiction with invalidation status", + }, { + 0x9840, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Security management - unsuccessful CHV verification, no attempt left", + }, { + 0x9850, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Security management - increase cannot be performed, max value reached", + }, { + 0x6700, 0xff00, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Application independent - incorrect parameter P3", + }, { + 0x6b00, 0xff00, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Application independent - incorrect parameter P1 or P2", + }, { + 0x6d00, 0xff00, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Application independent - unknown instruction code", + }, { + 0x6e00, 0xff00, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Application independent - wrong instruction class", + }, { + 0x6f00, 0xff00, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Application independent - technical problem with no diagnostic given", + }, + OSIM_CARD_SW_LAST +}; + +static const struct osim_card_sw *sim_card_sws[] = { + ts11_11_sw, + NULL +}; + +static int iccid_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data) +{ + struct osim_decoded_element *elem; + + elem = element_alloc(dd, "ICCID", ELEM_T_BCD, ELEM_REPR_DEC); + elem->length = len; + elem->u.buf = talloc_memdup(elem, data, len); + + return 0; +} + +static int elp_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data) +{ + int i, num_lp = len / 2; + + for (i = 0; i < num_lp; i++) { + uint8_t *cur = data + i*2; + struct osim_decoded_element *elem; + elem = element_alloc(dd, "Language Code", ELEM_T_STRING, ELEM_REPR_NONE); + elem->u.buf = (uint8_t *) talloc_strndup(elem, (const char *) cur, 2); + } + + return 0; +} + +static int default_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data) +{ + struct osim_decoded_element *elem; + + elem = element_alloc(dd, "Unknown Payload", ELEM_T_BYTES, ELEM_REPR_HEX); + elem->u.buf = talloc_memdup(elem, data, len); + + return 0; +} + + +/* 10.3.1 */ +int gsm_lp_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data) +{ + int i; + + for (i = 0; i < len; i++) { + struct osim_decoded_element *elem; + elem = element_alloc(dd, "Language Code", ELEM_T_UINT8, ELEM_REPR_DEC); + elem->u.u8 = data[i]; + } + + return 0; +} + +/* 10.3.2 */ +int gsm_imsi_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data) +{ + struct osim_decoded_element *elem; + + if (len < 2) + return -EINVAL; + + elem = element_alloc(dd, "IMSI", ELEM_T_BCD, ELEM_REPR_DEC); + elem->length = data[0]; + elem->u.buf = talloc_memdup(elem, data+1, len-1); + + return 0; +} + +/* 10.3.3 */ +static int gsm_kc_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data) +{ + struct osim_decoded_element *kc, *cksn; + + if (len < 9) + return -EINVAL; + + kc = element_alloc(dd, "Kc", ELEM_T_BYTES, ELEM_REPR_HEX); + kc->u.buf = talloc_memdup(kc, data, 8); + cksn = element_alloc(dd, "CKSN", ELEM_T_UINT8, ELEM_REPR_DEC); + cksn->u.u8 = data[8]; + + return 0; +} + +/* 10.3.4 */ +static int gsm_plmnsel_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data) +{ + int i, n_plmn = len / 3; + + if (n_plmn < 1) + return -EINVAL; + + for (i = 0; i < n_plmn; i++) { + uint8_t *cur = data + 3*i; + struct osim_decoded_element *elem, *mcc, *mnc; + uint8_t ra_buf[6]; + struct gprs_ra_id ra_id; + + memset(ra_buf, 0, sizeof(ra_buf)); + memcpy(ra_buf, cur, 3); + gsm48_parse_ra(&ra_id, ra_buf); + + elem = element_alloc(dd, "PLMN", ELEM_T_GROUP, ELEM_REPR_NONE); + + mcc = element_alloc_sub(elem, "MCC", ELEM_T_UINT16, ELEM_REPR_DEC); + mcc->u.u16 = ra_id.mcc; + + mnc = element_alloc_sub(elem, "MNC", ELEM_T_UINT16, ELEM_REPR_DEC); + mnc->u.u16 = ra_id.mnc; + } + + return 0; +} + +/* 10.3.5 */ +int gsm_hpplmn_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data) +{ + struct osim_decoded_element *elem; + + elem = element_alloc(dd, "Time interval", ELEM_T_UINT8, ELEM_REPR_DEC); + elem->u.u8 = *data; + + return 0; +} + +/* Chapter 10.2.x */ +static const struct osim_file_desc sim_ef_in_mf[] = { + EF_TRANSP(0x2FE2, "EF.ICCID", 0, + "ICC Identification", &iccid_decode, NULL), + EF_TRANSP(0x2F05, "EF.ELP", F_OPTIONAL, + "Extended language preference", &elp_decode, NULL), +}; + +/* Chapter 10.3.x */ +static const struct osim_file_desc sim_ef_in_gsm[] = { + EF_TRANSP(0x6F05, "EF.LP", 0, + "Language preference", &gsm_lp_decode, NULL), + EF_TRANSP(0x6F07, "EF.IMSI", 0, + "IMSI", &gsm_imsi_decode, NULL), + EF_TRANSP(0x6F20, "EF.Kc", 0, + "Ciphering key Kc", &gsm_kc_decode, NULL), + EF_TRANSP(0x6F30, "EF.PLMNsel", F_OPTIONAL, + "PLMN selector", &gsm_plmnsel_decode, NULL), + EF_TRANSP(0x6F31, "EF.HPPLMN", 0, + "Higher Priority PLMN search period", &gsm_hpplmn_decode, NULL), + EF_TRANSP_N(0x6F37, "EF.ACMmax", F_OPTIONAL, + "ACM maximum value"), + EF_TRANSP_N(0x6F38, "EF.SST", 0, + "SIM service table"), + EF_CYCLIC_N(0x6F39, "EF.ACM", F_OPTIONAL, + "Accumulated call meter"), + EF_TRANSP_N(0x6F3E, "EF.GID1", F_OPTIONAL, + "Group Identifier Level 1"), + EF_TRANSP_N(0x6F3F, "EF.GID2", F_OPTIONAL, + "Group Identifier Level 2"), + EF_TRANSP_N(0x6F46, "EF.SPN", F_OPTIONAL, + "Service Provider Name"), + EF_TRANSP_N(0x6F41, "EF.PUCT", F_OPTIONAL, + "Price per unit and currency table"), + EF_TRANSP_N(0x6F45, "EF.CBMI", F_OPTIONAL, + "Cell broadcast massage identifier selection"), + EF_TRANSP_N(0x6F74, "EF.BCCH", 0, + "Broadcast control channels"), + EF_TRANSP_N(0x6F78, "EF.ACC", 0, + "Access control class"), + EF_TRANSP_N(0x6F7B, "EF.FPLMN", 0, + "Forbidden PLMNs"), + EF_TRANSP_N(0x6F7E, "EF.LOCI", 0, + "Location information"), + EF_TRANSP_N(0x6FAD, "EF.AD", 0, + "Administrative data"), + EF_TRANSP_N(0x6FAE, "EF.Phase", 0, + "Phase identification"), + EF_TRANSP_N(0x6FB1, "EF.VGCS", F_OPTIONAL, + "Voice Group Call Service"), + EF_TRANSP_N(0x6FB2, "EF.VGCSS", F_OPTIONAL, + "Voice Group Call Service Status"), + EF_TRANSP_N(0x6FB3, "EF.VBS", F_OPTIONAL, + "Voice Broadcast Service"), + EF_TRANSP_N(0x6FB4, "EF.VBSS", F_OPTIONAL, + "Voice Broadcast Service Status"), + EF_TRANSP_N(0x6FB5, "EF.eMLPP", F_OPTIONAL, + "enhanced Mult Level Pre-emption and Priority"), + EF_TRANSP_N(0x6FB6, "EF.AAeM", F_OPTIONAL, + "Automatic Answer for eMLPP Service"), + EF_TRANSP_N(0x6F48, "EF.CBMID", F_OPTIONAL, + "Cell Broadcast Message Identifier for Data Download"), + EF_TRANSP_N(0x6FB7, "EF.ECC", F_OPTIONAL, + "Emergency Call Code"), + EF_TRANSP_N(0x6F50, "EF.CBMIR", F_OPTIONAL, + "Cell broadcast message identifier range selection"), + EF_TRANSP_N(0x6F2C, "EF.DCK", F_OPTIONAL, + "De-personalization Control Keys"), + EF_TRANSP_N(0x6F32, "EF.CNL", F_OPTIONAL, + "Co-operative Network List"), + EF_LIN_FIX_N(0x6F51, "EF.NIA", F_OPTIONAL, + "Network's Indication of Alerting"), + EF_TRANSP_N(0x6F52, "EF.KcGPRS", F_OPTIONAL, + "GPRS Ciphering key KcGPRS"), + EF_TRANSP_N(0x6F53, "EF.LOCIGPRS", F_OPTIONAL, + "GPRS location information"), + EF_TRANSP_N(0x6F54, "EF.SUME", F_OPTIONAL, + "SetUpMenu Elements"), + EF_TRANSP_N(0x6F60, "EF.PLMNwAcT", F_OPTIONAL, + "User controlled PLMN Selector with Access Technology"), + EF_TRANSP_N(0x6F61, "EF.OPLMNwAcT", F_OPTIONAL, + "Operator controlled PLMN Selector with Access Technology"), + EF_TRANSP_N(0x6F62, "EF.HPLMNwAcT", F_OPTIONAL, + "HPLMN Selector with Access Technology"), + EF_TRANSP_N(0x6F63, "EF.CPBCCH", F_OPTIONAL, + "CPBCCH Information"), + EF_TRANSP_N(0x6F64, "EF.InvScan", F_OPTIONAL, + "Investigation Scan"), +}; + +/* 10.5. */ +static const struct osim_file_desc sim_ef_in_telecom[] = { + EF_LIN_FIX_N(0x6F3A, "EF.ADN", F_OPTIONAL, + "Abbreviated dialling numbers"), + EF_LIN_FIX_N(0x6F3B, "EF.FDN", F_OPTIONAL, + "Fixed dialling numbers"), + EF_LIN_FIX_N(0x6F3C, "EF.SMS", F_OPTIONAL, + "Short messages"), + EF_LIN_FIX_N(0x6F3D, "EF.CCP", F_OPTIONAL, + "Capability configuration parameters"), + EF_LIN_FIX_N(0x6F4F, "EF.ECCP", F_OPTIONAL, + "Extended Capability configuration parameters"), + EF_LIN_FIX_N(0x6F40, "EF.MSISDN", F_OPTIONAL, + "MSISDN"), + EF_LIN_FIX_N(0x6F42, "EF.SMSP", F_OPTIONAL, + "Short message service parameters"), + EF_TRANSP_N(0x6F43, "EF.SMSS", F_OPTIONAL, + "SMS Status"), + EF_CYCLIC_N(0x6F44, "EF.LND", F_OPTIONAL, + "Last number dialled"), + EF_LIN_FIX_N(0x6F4A, "EF.EXT1", F_OPTIONAL, + "Extension 1"), + EF_LIN_FIX_N(0x6F4B, "EF.EXT2", F_OPTIONAL, + "Extension 2"), + EF_LIN_FIX_N(0x6F4C, "EF.EXT3", F_OPTIONAL, + "Extension 3"), + EF_LIN_FIX_N(0x6F4D, "EF.BDN", F_OPTIONAL, + "Barred dialling numbers"), + EF_LIN_FIX_N(0x6F4E, "EF.EXT4", F_OPTIONAL, + "Extension 4"), + EF_LIN_FIX_N(0x6F47, "EF.SMSR", F_OPTIONAL, + "Short message status reports"), + EF_LIN_FIX_N(0x6F58, "EF.CMI", F_OPTIONAL, + "Comparison Method Information"), +}; + + +/* 10.6. */ +static const struct osim_file_desc sim_ef_in_graphics[] = { + EF_LIN_FIX_N(0x4F20, "EF.IMG", F_OPTIONAL, + "Image"), +}; + +struct osim_card_profile *osim_cprof_sim(void *ctx) +{ + struct osim_card_profile *cprof; + struct osim_file_desc *mf, *gsm, *tc; + + cprof = talloc_zero(ctx, struct osim_card_profile); + cprof->name = "GSM SIM"; + cprof->sws = sim_card_sws; + + mf = alloc_df(cprof, 0x3f00, "MF"); + + cprof->mf = mf; + + add_filedesc(mf, sim_ef_in_mf, ARRAY_SIZE(sim_ef_in_mf)); + gsm = add_df_with_ef(mf, 0x7F20, "DF.GSM", sim_ef_in_gsm, + ARRAY_SIZE(sim_ef_in_gsm)); + add_df_with_ef(gsm, 0x5F30, "DF.IRIDIUM", NULL, 0); + add_df_with_ef(gsm, 0x5F31, "DF.GLOBST", NULL, 0); + add_df_with_ef(gsm, 0x5F32, "DF.ICO", NULL, 0); + add_df_with_ef(gsm, 0x5F33, "DF.ACeS", NULL, 0); + add_df_with_ef(gsm, 0x5F40, "DF.ACeS", NULL, 0); + add_df_with_ef(gsm, 0x5F60, "DF.CTS", NULL, 0); + add_df_with_ef(gsm, 0x5F70, "DF.SoLSA", NULL, 0); + tc = add_df_with_ef(mf, 0x7F10, "DF.TELECOM", sim_ef_in_telecom, + ARRAY_SIZE(sim_ef_in_telecom)); + add_df_with_ef(tc, 0x5F50, "DF.GRAPHICS", sim_ef_in_graphics, + ARRAY_SIZE(sim_ef_in_graphics)); + + return cprof; +} diff --git a/src/sim/card_fs_uicc.c b/src/sim/card_fs_uicc.c new file mode 100644 index 00000000..03dbad32 --- /dev/null +++ b/src/sim/card_fs_uicc.c @@ -0,0 +1,185 @@ +#include +#include + +/* TS 102 221 V10.0.0 / 10.2.1 */ +const struct osim_card_sw ts102221_uicc_sw[] = { + { + 0x9000, 0xffff, SW_TYPE_STR, SW_CLS_OK, + .u.str = "Normal ending of the command", + }, { + 0x9100, 0xff00, SW_TYPE_STR, SW_CLS_OK, + .u.str = "Normal ending of the command, extra info proactive", + }, { + 0x9200, 0xff00, SW_TYPE_STR, SW_CLS_OK, + .u.str = "Normal ending of the command, extra info regarding transfer session", + }, { + 0x9300, 0xff00, SW_TYPE_STR, SW_CLS_POSTP, + .u.str = "SIM Application Toolkit is busy, command cannot be executed at present", + }, { + 0x6200, 0xffff, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "No information given, state of non volatile memory unchanged", + }, { + 0x6281, 0xffff, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "Part of returned data may be corrupted", + }, { + 0x6282, 0xffff, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "End of file/record reached before reading Le bytes", + }, { + 0x6283, 0xffff, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "Selected file invalidated", + }, { + 0x6285, 0xffff, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "Selected file in termination state", + }, { + 0x62f1, 0xffff, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "More data available", + }, { + 0x62f2, 0xffff, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "More data available and proactive command pending", + }, { + 0x62f3, 0xffff, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "Response data available", + }, { + 0x63f1, 0xffff, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "More data expected", + }, { + 0x63c0, 0xfff0, SW_TYPE_STR, SW_CLS_WARN, + .u.str = "Verification falied, X retries remaining", + }, { + 0x6400, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Execution - No information given, state of non-volatile memory unchanged", + }, { + 0x6500, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Execution - No information given, state of non-volatile memory changed", + }, { + 0x6581, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Execution - Memory problem", + }, { + 0x6700, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Checking - Wrong length", + }, { + 0x6700, 0xff00, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Checking - Command dependent error", + }, { + 0x6b00, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Checking - Wrong parameter(s) P1-P2", + }, { + 0x6d00, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Checking - Instruction code not supported or valid", + }, { + 0x6e00, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Checking - Class not supported", + }, { + 0x6f00, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Checking - Technical problem, no precise diagnostics", + }, { + 0x6f00, 0xff00, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Checking - Command dependent error", + }, { + 0x6800, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Function in CLA not supported - No information given", + }, { + 0x6881, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Function in CLA not supported - Logical channel not supported", + }, { + 0x6882, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Function in CLA not supportied - Secure messaging not supported", + }, { + 0x6900, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Command not allowed - No information given", + }, { + 0x6981, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Command not allowed - Command incompatible with file structure", + }, { + 0x6982, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Command not allowed - Security status not satisfied", + }, { + 0x6983, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Command not allowed - Authentication/PIN method blocked", + }, { + 0x6984, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Command not allowed - Referenced data invalidated", + }, { + 0x6985, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Command not allowed - Conditions of use not satisfied", + }, { + 0x6986, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Command not allowed - Noe EF selected", + }, { + 0x6989, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Command not allowed - secure channel - security not satisfied", + }, { + 0x6a80, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Wrong parameters - Incorrect parameters in the data field", + }, { + 0x6a81, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Wrong parameters - Function not supported", + }, { + 0x6a82, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Wrong parameters - File not found", + }, { + 0x6a83, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Wrong parameters - Record not found", + }, { + 0x6a84, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Wrong parameters - Not enough memory space", + }, { + 0x6a86, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Wrong parameters - Incorrect parameters P1 to P2", + }, { + 0x6a87, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Wrong parameters - Lc inconsistent with P1 ot P2", + }, { + 0x6a88, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Wrong parameters - Referenced data not found", + }, { + 0x9850, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Application error - INCREASE cannot be performed, max value reached", + }, { + 0x9862, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Application error - Authentication error, application specific", + }, { + 0x9863, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Application error - Security session or association expired", + }, + OSIM_CARD_SW_LAST +}; + +const struct value_string ts102221_fcp_vals[14] = { + { UICC_FCP_T_FCP, "File control parameters" }, + { UICC_FCP_T_FILE_SIZE, "File size" }, + { UICC_FCP_T_TOT_F_SIZE, "Total size of files" }, + { UICC_FCP_T_FILE_DESC, "File descriptor" }, + { UICC_FCP_T_FILE_ID, "File identifier" }, + { UICC_FCP_T_DF_NAME, "DF name" }, + { UICC_FCP_T_SFID, "Short file identifier" }, + { UICC_FCP_T_LIFEC_STS, "Lifecycle status integer" }, + { UICC_FCP_T_SEC_ATTR_REFEXP, "Security attributes (Referenced/Expanded)" }, + { UICC_FCP_T_SEC_ATTR_COMP, "Security attributes (Compact)" }, + { UICC_FCP_T_PROPRIETARY, "Proprietary" }, + { UICC_FCP_T_SEC_ATTR_EXP, "Security attributes (Expanded)" }, + { UICC_FCP_T_PIN_STS_DO, "PIN Status DO" }, + { 0, NULL } +}; + +/* FIXME: Ber-TLV ?? */ +const struct tlv_definition ts102221_fcp_tlv_def = { + .def = { + [UICC_FCP_T_FCP] = { TLV_TYPE_TLV }, + [UICC_FCP_T_FILE_SIZE] = { TLV_TYPE_TLV }, + [UICC_FCP_T_TOT_F_SIZE] = { TLV_TYPE_TLV }, + [UICC_FCP_T_FILE_DESC] = { TLV_TYPE_TLV }, + [UICC_FCP_T_FILE_ID] = { TLV_TYPE_TLV }, + [UICC_FCP_T_DF_NAME] = { TLV_TYPE_TLV }, + [UICC_FCP_T_SFID] = { TLV_TYPE_TLV }, + [UICC_FCP_T_LIFEC_STS] = { TLV_TYPE_TLV }, + [UICC_FCP_T_SEC_ATTR_REFEXP] = { TLV_TYPE_TLV }, + [UICC_FCP_T_SEC_ATTR_COMP] = { TLV_TYPE_TLV }, + [UICC_FCP_T_PROPRIETARY] = { TLV_TYPE_TLV }, + [UICC_FCP_T_SEC_ATTR_EXP] = { TLV_TYPE_TLV }, + [UICC_FCP_T_PIN_STS_DO] = { TLV_TYPE_TLV }, + }, +}; + +/* Annex E - TS 101 220 */ +static const uint8_t adf_uicc_aid[] = { 0xA0, 0x00, 0x00, 0x00, 0x87, 0x10, 0x01 }; diff --git a/src/sim/card_fs_usim.c b/src/sim/card_fs_usim.c new file mode 100644 index 00000000..361c2e88 --- /dev/null +++ b/src/sim/card_fs_usim.c @@ -0,0 +1,288 @@ + +#include +#include + +#include +#include +#include + +#include "sim_int.h" +#include "gsm_int.h" + +/* TS 31.102 Version 7.7.0 / Chapoter 7.3 */ +const struct osim_card_sw ts31_102_sw[] = { + { + 0x9862, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Security management - Authentication error, incorrect MAC", + }, { + 0x9864, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Security management - Authentication error, security context not supported", + }, { + 0x9865, 0xffff, SW_TYPE_STR, SW_CLS_ERROR, + .u.str = "Security management - Key freshness error", + }, + OSIM_CARD_SW_LAST +}; + +static const struct osim_card_sw *usim_card_sws[] = { + ts31_102_sw, + ts102221_uicc_sw, + NULL +}; + + +static int default_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data) +{ + struct osim_decoded_element *elem; + + elem = element_alloc(dd, "Unknown Payload", ELEM_T_BYTES, ELEM_REPR_HEX); + elem->u.buf = talloc_memdup(elem, data, len); + + return 0; +} + +/* TS 102 221 Chapter 13.1 */ +static const struct osim_file_desc uicc_ef_in_mf[] = { + EF_LIN_FIX_N(0x2f00, "EF.DIR", 0, + "Application directory"), + EF_TRANSP_N(0x2FE2, "EF.ICCID", 0, + "ICC Identification"), + EF_TRANSP_N(0x2F05, "EF.PL", 0, + "Preferred Languages"), + EF_LIN_FIX_N(0x2F06, "EF.ARR", F_OPTIONAL, + "Access Rule Reference"), +}; + +static const struct osim_file_desc usim_ef_in_df_gsm_access[] = { + EF_TRANSP_N(0x4f20, "EF.Kc", 0, + "Ciphering Key Kc"), + EF_TRANSP_N(0x4f52, "EF.KcGPRS", 0, + "GPRS Ciphering key KcGPRS"), + EF_TRANSP_N(0x4f63, "EF.CPBCCH", F_OPTIONAL, + "CPBCCH Information"), + EF_TRANSP_N(0x4f64, "EF.invSCAN", F_OPTIONAL, + "Investigation Scan"), +}; + +/* 31.102 Chapter 4.2 */ +static const struct osim_file_desc usim_ef_in_adf_usim[] = { + EF_TRANSP(0x6F05, "EF.LI", 0, + "Language Indication", &gsm_lp_decode, NULL), + EF_TRANSP(0x6F07, "EF.IMSI", 0, + "IMSI", &gsm_imsi_decode, NULL), + EF_TRANSP_N(0x6F08, "EF.Keys", 0, + "Ciphering and Integrity Keys"), + EF_TRANSP_N(0x6F09, "EF.KeysPS", 0, + "Ciphering and Integrity Keys for Packet Switched domain"), + EF_TRANSP_N(0x6F60, "EF.PLMNwAcT", F_OPTIONAL, + "User controlled PLMN Selector with Access Technology"), + EF_TRANSP(0x6F31, "EF.HPPLMN", 0, + "Higher Priority PLMN search period", &gsm_hpplmn_decode, NULL), + EF_TRANSP_N(0x6F37, "EF.ACMmax", F_OPTIONAL, + "ACM maximum value"), + EF_TRANSP_N(0x6F38, "EF.UST", 0, + "USIM Service Table"), + EF_CYCLIC_N(0x6F39, "EF.ACM", F_OPTIONAL, + "Accumulated call meter"), + EF_TRANSP_N(0x6F3E, "EF.GID1", F_OPTIONAL, + "Group Identifier Level 1"), + EF_TRANSP_N(0x6F3F, "EF.GID2", F_OPTIONAL, + "Group Identifier Level 2"), + EF_TRANSP_N(0x6F46, "EF.SPN", F_OPTIONAL, + "Service Provider Name"), + EF_TRANSP_N(0x6F41, "EF.PUCT", F_OPTIONAL, + "Price per unit and currency table"), + EF_TRANSP_N(0x6F45, "EF.CBMI", F_OPTIONAL, + "Cell broadcast massage identifier selection"), + EF_TRANSP_N(0x6F78, "EF.ACC", 0, + "Access control class"), + EF_TRANSP_N(0x6F7B, "EF.FPLMN", 0, + "Forbidden PLMNs"), + EF_TRANSP_N(0x6F7E, "EF.LOCI", 0, + "Location information"), + EF_TRANSP_N(0x6FAD, "EF.AD", 0, + "Administrative data"), + EF_TRANSP_N(0x6F48, "EF.CBMID", F_OPTIONAL, + "Cell Broadcast Message Identifier for Data Download"), + EF_TRANSP_N(0x6FB7, "EF.ECC", F_OPTIONAL, + "Emergency Call Code"), + EF_TRANSP_N(0x6F50, "EF.CBMIR", F_OPTIONAL, + "Cell broadcast message identifier range selection"), + EF_TRANSP_N(0x6F73, "EF.PSLOCI", 0, + "Pacet Switched location information"), + EF_LIN_FIX_N(0x6F3B, "EF.FDN", F_OPTIONAL, + "Fixed dialling numbers"), + EF_LIN_FIX_N(0x6F3C, "EF.SMS", F_OPTIONAL, + "Short messages"), + EF_LIN_FIX_N(0x6F40, "EF.MSISDN", F_OPTIONAL, + "MSISDN"), + EF_LIN_FIX_N(0x6F42, "EF.SMSP", F_OPTIONAL, + "Short message service parameters"), + EF_TRANSP_N(0x6F43, "EF.SMSS", F_OPTIONAL, + "SMS Status"), + EF_LIN_FIX_N(0x6F49, "EF.SDN", F_OPTIONAL, + "Service Dialling Numbers"), + EF_LIN_FIX_N(0x6F4B, "EF.EXT2", F_OPTIONAL, + "Extension 2"), + EF_LIN_FIX_N(0x6F4C, "EF.EXT3", F_OPTIONAL, + "Extension 3"), + EF_LIN_FIX_N(0x6F47, "EF.SMSR", F_OPTIONAL, + "Short message status reports"), + EF_CYCLIC_N(0x6F80, "EF.ICI", F_OPTIONAL, + "Incoming Calling Information"), + EF_CYCLIC_N(0x6F81, "EF.OCI", F_OPTIONAL, + "Outgoing Calling Information"), + EF_CYCLIC_N(0x6F82, "EF.ICT", F_OPTIONAL, + "Incoming Call Timer"), + EF_CYCLIC_N(0x6F83, "EF.OCT", F_OPTIONAL, + "Outgoing Call Timer"), + EF_LIN_FIX_N(0x6F4E, "EF.EXT5", F_OPTIONAL, + "Extension 5"), + EF_LIN_FIX_N(0x6F4F, "EF.CCP2", F_OPTIONAL, + "Capability Configuration Parameters 2"), + EF_TRANSP_N(0x6FB5, "EF.eMLPP", F_OPTIONAL, + "enhanced Multi Level Precedence and Pre-emption"), + EF_TRANSP_N(0x6FB6, "EF.AAeM", F_OPTIONAL, + "Automatic Answer for eMLPP Service"), + EF_TRANSP_N(0x6FC3, "EF.Hiddenkey", F_OPTIONAL, + "Key for hidden phone book entries"), + EF_LIN_FIX_N(0x6F4D, "EF.BDN", F_OPTIONAL, + "Barred Dialling Numbers"), + EF_LIN_FIX_N(0x6F4E, "EF.EXT4", F_OPTIONAL, + "Extension 4"), + EF_LIN_FIX_N(0x6F58, "EF.CMI", F_OPTIONAL, + "Comparison Method Information"), + EF_TRANSP_N(0x6F56, "EF.EST", F_OPTIONAL, + "Enhanced Services Table"), + EF_TRANSP_N(0x6F57, "EF.ACL", F_OPTIONAL, + "Access Point Name Control List"), + EF_TRANSP_N(0x6F2C, "EF.DCK", F_OPTIONAL, + "Depersonalisation Control Keys"), + EF_TRANSP_N(0x6F32, "EF.CNL", F_OPTIONAL, + "Co-operative Network List"), + EF_TRANSP_N(0x6F5B, "EF.START-HFN", 0, + "Initialisation values for Hyperframe number"), + EF_TRANSP_N(0x6F5C, "EF.THRESHOLD", 0, + "Maximum value of START"), + EF_TRANSP_N(0x6F61, "EF.OPLMNwAcT", F_OPTIONAL, + "Operator controlled PLMN Selector with Access Technology"), + EF_TRANSP_N(0x6F62, "EF.HPLMNwAcT", F_OPTIONAL, + "HPLMN Selector with Access Technology"), + EF_LIN_FIX_N(0x6F06, "EF.ARR", 0, + "Access Rule Reference"), + EF_TRANSP_N(0x6FC4, "EF.NETPAR", 0, + "Network Parameters"), + EF_LIN_FIX_N(0x6FC5, "EF.PNN", F_OPTIONAL, + "PLMN Network Name"), + EF_LIN_FIX_N(0x6FC6, "EF.OPL", F_OPTIONAL, + "Operator PLMN List"), + EF_LIN_FIX_N(0x6FC7, "EF.MBDN", F_OPTIONAL, + "Mailbox Dialling Numbers"), + EF_LIN_FIX_N(0x6FC8, "EF.EXT6", F_OPTIONAL, + "Extension 6"), + EF_LIN_FIX_N(0x6FC9, "EF.MBI", F_OPTIONAL, + "Mailbox Identifier"), + EF_LIN_FIX_N(0x6FCA, "EF.MWIS", F_OPTIONAL, + "Message Waiting Indication Status"), + EF_LIN_FIX_N(0x6FCB, "EF.CFIS", F_OPTIONAL, + "Call Forwarding Indication Status"), + EF_LIN_FIX_N(0x6FCC, "EF.EXT7", F_OPTIONAL, + "Extension 7"), + EF_TRANSP_N(0x6FCD, "EF.SPDI", F_OPTIONAL, + "Service Provider Display Information"), + EF_LIN_FIX_N(0x6FCE, "EF.MMSN", F_OPTIONAL, + "MMS Notification"), + EF_LIN_FIX_N(0x6FCF, "EF.EXT8", F_OPTIONAL, + "Extension 8"), + EF_TRANSP_N(0x6FD0, "EF.MMSICP", F_OPTIONAL, + "MMS Issuer Connectivity Parameters"), + EF_LIN_FIX_N(0x6FD1, "EF.MMSUP", F_OPTIONAL, + "MMS User Preferences"), + EF_TRANSP_N(0x6FD2, "EF.MMSUCP", F_OPTIONAL, + "MMS User Connectivity Parameters"), + EF_LIN_FIX_N(0x6FD3, "EF.NIA", F_OPTIONAL, + "Network's Indication of Alerting"), + EF_TRANSP_N(0x6FB1, "EF.VGCS", F_OPTIONAL, + "Voice Group Call Service"), + EF_TRANSP_N(0x6FB2, "EF.VGCSS", F_OPTIONAL, + "Voice Group Call Service Status"), + EF_TRANSP_N(0x6FB3, "EF.VBS", F_OPTIONAL, + "Voice Broadcast Service"), + EF_TRANSP_N(0x6FB4, "EF.VBSS", F_OPTIONAL, + "Voice Broadcast Service Status"), + EF_TRANSP_N(0x6FD4, "EF.VGCSCA", F_OPTIONAL, + "Voice Group Call Service Ciphering Algorithm"), + EF_TRANSP_N(0x6FD5, "EF.VBSCA", F_OPTIONAL, + "Voice Broadcast Service Ciphering Algorithm"), + EF_TRANSP_N(0x6FD6, "EF.GBABP", F_OPTIONAL, + "GBA Bootstrapping parameters"), + EF_LIN_FIX_N(0x6FD7, "EF.MSK", F_OPTIONAL, + "MBMS Serviec Key List"), + EF_LIN_FIX_N(0x6FD8, "EF.MUK", F_OPTIONAL, + "MBMS User Key"), + EF_LIN_FIX_N(0x6FDA, "EF.GBANL", F_OPTIONAL, + "GBA NAF List"), + EF_TRANSP_N(0x6FD9, "EF.EHPLMN", F_OPTIONAL, + "Equivalent HPLMN"), +}; + + + +/* 31.102 Chapter 4.4.1 */ +static const struct osim_file_desc usim_ef_in_solsa[] = { + EF_TRANSP_N(0x4F30, "EF.SAI", F_OPTIONAL, + "SoLSA Access Indicator"), + EF_LIN_FIX_N(0x4F31, "EF.SLL", F_OPTIONAL, + "SoLSA LSA List"), + /* LSA descriptor files 4Fxx, hard to represent here */ +}; + +/* Annex E - TS 101 220 */ +static const uint8_t adf_usim_aid[] = { 0xA0, 0x00, 0x00, 0x00, 0x87, 0x10, 0x02 }; + +struct osim_card_profile *osim_cprof_usim(void *ctx) +{ + struct osim_card_profile *cprof; + struct osim_file_desc *mf, *gsm, *tc, *uadf; + + cprof = talloc_zero(ctx, struct osim_card_profile); + cprof->name = "3GPP USIM"; + cprof->sws = usim_card_sws; + + mf = alloc_df(cprof, 0x3f00, "MF"); + + cprof->mf = mf; + + /* Core UICC Files */ + add_filedesc(mf, uicc_ef_in_mf, ARRAY_SIZE(uicc_ef_in_mf)); + + /* ADF.USIM with its EF siblings */ + uadf = add_adf_with_ef(mf, adf_usim_aid, sizeof(adf_usim_aid), + "ADF.USIM", usim_ef_in_adf_usim, + ARRAY_SIZE(usim_ef_in_adf_usim)); + + /* DFs under ADF.USIM */ + add_df_with_ef(uadf, 0x5F3A, "DF.PHONEBOOK", NULL, 0); + add_df_with_ef(uadf, 0x5F3B, "DF.GSM-ACCESS", usim_ef_in_df_gsm_access, + ARRAY_SIZE(usim_ef_in_df_gsm_access)); + add_df_with_ef(uadf, 0x5F3C, "DF.MExE", NULL, 0); + add_df_with_ef(uadf, 0x5F40, "DF.WLAN", NULL, 0); + add_df_with_ef(uadf, 0x5F70, "DF.SoLSA", usim_ef_in_solsa, ARRAY_SIZE(usim_ef_in_solsa)); + +#if 0 + /* DF.TELECOM as sub-directory of MF */ + tc = add_df_with_ef(mf, 0x7F10, "DF.TELECOM", sim_ef_in_telecom, + ARRAY_SIZE(sim_ef_in_telecom)); + add_df_with_ef(tc, 0x5F50, "DF.GRAPHICS", sim_ef_in_graphics, + ARRAY_SIZE(sim_ef_in_graphics)); + + /* DF.GSM for backwards compatibility */ + gsm = add_df_with_ef(mf, 0x7F20, "DF.GSM", sim_ef_in_gsm, + ARRAY_SIZE(sim_ef_in_gsm)); + /* FIXME: DF's below DF.GSM (51.011) */ +#endif + + return cprof; +} diff --git a/src/sim/core.c b/src/sim/core.c new file mode 100644 index 00000000..40a49cf2 --- /dev/null +++ b/src/sim/core.c @@ -0,0 +1,172 @@ +#include +#include + +#include +#include + +static struct osim_decoded_element * +__element_alloc(void *ctx, const char *name, enum osim_element_type type, + enum osim_element_repr repr) +{ + struct osim_decoded_element *elem; + + elem = talloc_zero(ctx, struct osim_decoded_element); + if (!elem) + return NULL; + elem->name = name; + elem->type = type; + elem->representation = repr; + + if (elem->type == ELEM_T_GROUP) + INIT_LLIST_HEAD(&elem->u.siblings); + + return elem; +} + + +struct osim_decoded_element * +element_alloc(struct osim_decoded_data *dd, const char *name, + enum osim_element_type type, enum osim_element_repr repr) +{ + struct osim_decoded_element *elem; + + elem = __element_alloc(dd, name, type, repr); + if (!elem) + return NULL; + + llist_add_tail(&elem->list, &dd->decoded_elements); + + return elem; +} + +struct osim_decoded_element * +element_alloc_sub(struct osim_decoded_element *ee, const char *name, + enum osim_element_type type, enum osim_element_repr repr) +{ + struct osim_decoded_element *elem; + + elem = __element_alloc(ee, name, type, repr); + if (!elem) + return NULL; + + llist_add(&elem->list, &ee->u.siblings); + + return elem; +} + + +void add_filedesc(struct osim_file_desc *root, const struct osim_file_desc *in, int num) +{ + int i; + + for (i = 0; i < num; i++) { + struct osim_file_desc *ofd = talloc_memdup(root, &in[i], sizeof(*in)); + llist_add_tail(&ofd->list, &root->child_list); + } +} + +struct osim_file_desc *alloc_df(void *ctx, uint16_t fid, const char *name) +{ + struct osim_file_desc *mf; + + mf = talloc_zero(ctx, struct osim_file_desc); + mf->type = TYPE_DF; + mf->fid = fid; + mf->short_name = name; + INIT_LLIST_HEAD(&mf->child_list); + + return mf; +} + +struct osim_file_desc * +add_df_with_ef(struct osim_file_desc *parent, + uint16_t fid, const char *name, + const struct osim_file_desc *in, int num) +{ + struct osim_file_desc *df; + + df = alloc_df(parent, fid, name); + df->parent = parent; + llist_add_tail(&df->list, &parent->child_list); + add_filedesc(df, in, num); + + return df; +} + +struct osim_file_desc * +add_adf_with_ef(struct osim_file_desc *parent, + const uint8_t *adf_name, uint8_t adf_name_len, + const char *name, const struct osim_file_desc *in, + int num) +{ + struct osim_file_desc *df; + + df = alloc_df(parent, 0xffff, name); + df->type = TYPE_ADF; + df->df_name = adf_name; + df->df_name_len = adf_name_len; + df->parent = parent; + llist_add_tail(&df->list, &parent->child_list); + add_filedesc(df, in, num); + + return df; +} + +struct osim_file_desc * +osim_file_find_name(struct osim_file_desc *parent, const char *name) +{ + struct osim_file_desc *ofd; + llist_for_each_entry(ofd, &parent->child_list, list) { + if (!strcmp(ofd->short_name, name)) { + return ofd; + } + } + return NULL; +} + + + +struct msgb *osim_new_apdumsg(uint8_t cla, uint8_t ins, uint8_t p1, + uint8_t p2, uint16_t lc, uint16_t le) +{ + struct osim_apdu_cmd_hdr *ch; + struct msgb *msg = msgb_alloc(lc+le+sizeof(*ch)+2, "APDU"); + if (!msg) + return NULL; + + ch = (struct osim_apdu_cmd_hdr *) msgb_put(msg, sizeof(*ch)); + msg->l2h = (char *) ch; + + ch->cla = cla; + ch->ins = ins; + ch->p1 = p1; + ch->p2 = p2; + + msgb_apdu_lc(msg) = lc; + msgb_apdu_le(msg) = le; + + if (lc == 0 && le == 0) + msgb_apdu_case(msg) = APDU_CASE_1; + else if (lc == 0 && le >= 1) { + if (le <= 256) + msgb_apdu_case(msg) = APDU_CASE_2; + else + msgb_apdu_case(msg) = APDU_CASE_2_EXT; + } else if (le == 0 && lc >= 1) { + if (lc <= 255) + msgb_apdu_case(msg) = APDU_CASE_3; + else + msgb_apdu_case(msg) = APDU_CASE_3_EXT; + } else if (lc >= 1 && le >= 1) { + if (lc <= 255 & le <= 256) + msgb_apdu_case(msg) = APDU_CASE_4; + else + msgb_apdu_case(msg) = APDU_CASE_4_EXT; + } + + return msg; +} + + + + diff --git a/src/sim/file_codec.c b/src/sim/file_codec.c new file mode 100644 index 00000000..5bf5bc68 --- /dev/null +++ b/src/sim/file_codec.c @@ -0,0 +1,34 @@ + +#include + +#include +#include + +struct osim_decoded_data *osim_file_decode(struct osim_file *file, + int len, uint8_t *data) +{ + struct osim_decoded_data *dd; + + if (!file->desc->ops.parse) + return NULL; + + dd = talloc_zero(file, struct osim_decoded_data); + dd->file = file; + + if (file->desc->ops.parse(dd, file->desc, len, data) < 0) { + talloc_free(dd); + return NULL; + } else + return dd; +} + +struct msgb *osim_file_encode(const struct osim_file_desc *desc, + const struct osim_decoded_data *data) +{ + if (!desc->ops.encode) + return NULL; + + return desc->ops.encode(desc, data); +} + + diff --git a/src/sim/gsm_int.h b/src/sim/gsm_int.h new file mode 100644 index 00000000..3abb3e6f --- /dev/null +++ b/src/sim/gsm_int.h @@ -0,0 +1,12 @@ + +int gsm_hpplmn_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data); + +int gsm_lp_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data); + +int gsm_imsi_decode(struct osim_decoded_data *dd, + const struct osim_file_desc *desc, + int len, uint8_t *data); diff --git a/src/sim/reader.c b/src/sim/reader.c new file mode 100644 index 00000000..52cf18e9 --- /dev/null +++ b/src/sim/reader.c @@ -0,0 +1,224 @@ +#include +#include +#include +#include +#include + +#include + + +#include "sim_int.h" + +static int get_sw(struct msgb *resp) +{ + int ret; + + if (!msgb_apdu_de(resp) || msgb_apdu_le(resp) < 2) + return -EIO; + + ret = resp->data[resp->len-2] << 8; + ret |= resp->data[resp->len-1]; + + return ret; +} + +/* According to ISO7816-4 Annex A */ +static int transceive_apdu_t0(struct osim_card_hdl *st, struct msgb *amsg) +{ + struct osim_reader_hdl *rh = st->reader; + struct msgb *tmsg = msgb_alloc(1024, "TPDU"); + struct osim_apdu_cmd_hdr *tpduh; + uint8_t *cur; + uint16_t sw; + int rc, num_resp = 0; + + /* create TPDU header from APDU header */ + tpduh = (struct osim_apdu_cmd_hdr *) msgb_put(tmsg, sizeof(*tpduh)); + memcpy(tpduh, msgb_apdu_h(amsg), sizeof(*tpduh)); + + switch (msgb_apdu_case(amsg)) { + case APDU_CASE_1: + tpduh->p3 = 0x00; + break; + case APDU_CASE_2: + tpduh->p3 = msgb_apdu_le(amsg); + break; + case APDU_CASE_2_EXT: + if (msgb_apdu_le(amsg) <= 256) { + /* case 2E.1 */ + tpduh->p3 = msgb_apdu_le(amsg) & 0xff; + } else { + /* case 2E.2 */ + tpduh->p3 = 0; + msgb_put_u16(tmsg, msgb_apdu_le(amsg)); + } + break; + case APDU_CASE_3: + case APDU_CASE_4: + tpduh->p3 = msgb_apdu_lc(amsg); + cur = msgb_put(tmsg, tpduh->p3); + memcpy(cur, msgb_apdu_dc(amsg), tpduh->p3); + break; + case APDU_CASE_3_EXT: + case APDU_CASE_4_EXT: + if (msgb_apdu_lc(amsg) < 256) { + /* Case 3E.1 */ + tpduh->p3 = msgb_apdu_lc(amsg); + } else { + /* Case 3E.2 */ + /* FXIME: Split using ENVELOPE! */ + return -1; + } + break; + } + +transceive_again: + + /* store pointer to start of response */ + tmsg->l3h = tmsg->tail; + + /* transceive */ + rc = rh->ops->transceive(st->reader, tmsg); + if (rc < 0) { + msgb_free(tmsg); + return rc; + } + msgb_apdu_sw(tmsg) = get_sw(tmsg); + + /* increase number of responsese received */ + num_resp++; + + /* save SW */ + sw = msgb_apdu_sw(tmsg); + printf("sw = 0x%04x\n", sw); + msgb_apdu_sw(amsg) = sw; + + switch (msgb_apdu_case(amsg)) { + case APDU_CASE_1: + case APDU_CASE_3: + /* just copy SW */ + break; + case APDU_CASE_2: +case_2s: + switch (sw >> 8) { + case 0x67: /* Case 2S.2: Le definitely not accepted */ + break; + case 0x6c: /* Case 2S.3: Le not accepted, La indicated */ + tpduh->p3 = sw & 0xff; + /* re-issue the command with La as */ + goto transceive_again; + break; + case 0x90: + /* Case 2S.1, fall-through */ + case 0x91: case 0x92: case 0x93: case 0x94: case 0x95: + case 0x96: case 0x97: case 0x98: case 0x99: case 0x9a: + case 0x9b: case 0x9c: case 0x9d: case 0x9e: case 0x9f: + /* Case 2S.4 */ + /* copy response data over */ + cur = msgb_put(amsg, msgb_l3len(tmsg)); + memcpy(cur, tmsg->l3h, msgb_l3len(tmsg)); + } + break; + case APDU_CASE_4: + /* FIXME: this is 4S.2 only for 2nd... response: */ + if (num_resp >= 2) + goto case_2s; + + switch (sw >> 8) { + case 0x60: case 0x62: case 0x63: case 0x64: case 0x65: + case 0x66: case 0x67: case 0x68: case 0x69: case 0x6a: + case 0x6b: case 0x6c: case 0x6d: case 0x6e: case 0x6f: + /* Case 4S.1: Command not accepted: just copy SW */ + break; + case 0x90: + /* case 4S.2: Command accepted */ + tpduh->ins = 0xC0; + tpduh->p1 = tpduh->p2 = 0; + tpduh->p3 = msgb_apdu_le(amsg); + /* strip off current result */ + msgb_get(tmsg, msgb_length(tmsg)-sizeof(*tpduh)); + goto transceive_again; + break; + case 0x61: /* Case 4S.3: command accepted with info added */ + tpduh->ins = 0xC0; + tpduh->p1 = tpduh->p2 = 0; + tpduh->p3 = OSMO_MIN(msgb_apdu_le(amsg), sw & 0xff); + /* strip off current result */ + msgb_get(tmsg, msgb_length(tmsg)-sizeof(*tpduh)); + goto transceive_again; + break; + } + /* Case 4S.2: Command accepted: just copy SW */ + /* Case 4S.4: Just copy SW */ + break; + case APDU_CASE_2_EXT: + if (msgb_apdu_le(amsg) <= 256) { + /* Case 2E.1: Le <= 256 */ + goto case_2s; + } + switch (sw >> 8) { + case 0x67: + /* Case 2E.2a: wrong length, abort */ + break; + case 0x6c: + /* Case 2E.2b: wrong length, La given */ + tpduh->p3 = sw & 0xff; + /* re-issue the command with La as given */ + goto transceive_again; + break; + case 0x90: + /* Case 2E.2c: */ + break; + case 0x61: + /* Case 2E.2d: more data available */ + /* FIXME: issue yet another GET RESPONSE */ + break; + } + break; + case APDU_CASE_3_EXT: + /* FIXME: handling for ENVELOPE splitting */ + break; + case APDU_CASE_4_EXT: + break; + } + + msgb_free(tmsg); + + /* compute total length of response data */ + msgb_apdu_le(amsg) = amsg->tail - msgb_apdu_de(amsg); + + return sw; +} + +/* According to ISO7816-4 Annex B */ +static int transceive_apdu_t1(struct osim_card_hdl *st, struct msgb *amsg) +{ + return -1; +} + +int osim_transceive_apdu(struct osim_chan_hdl *st, struct msgb *amsg) +{ + /* FIXME: check for protocol */ + return transceive_apdu_t0(st->card, amsg); +} + + + +struct osim_reader_hdl *osim_reader_open(int idx, const char *name) +{ + /* FIXME: support multiple drivers */ + const struct osim_reader_ops *ops = &pcsc_reader_ops; + struct osim_reader_hdl *rh; + + rh = ops->reader_open(idx, name); + if (!rh) + return NULL; + rh->ops = ops; + + return rh; +} + +struct osim_card_hdl *osim_card_open(struct osim_reader_hdl *rh) +{ + return rh->ops->card_open(rh); +} diff --git a/src/sim/reader_pcsc.c b/src/sim/reader_pcsc.c new file mode 100644 index 00000000..0a36f49c --- /dev/null +++ b/src/sim/reader_pcsc.c @@ -0,0 +1,133 @@ +#include +#include +#include +#include + +#include +#include + +#include +#include + +#include "sim_int.h" + +#define PCSC_ERROR(rv, text) \ +if (rv != SCARD_S_SUCCESS) { \ + fprintf(stderr, text ": %s (0x%lX)\n", pcsc_stringify_error(rv), rv); \ + goto end; \ +} else { \ + printf(text ": OK\n\n"); \ +} + + + +struct pcsc_reader_state { + SCARDCONTEXT hContext; + SCARDHANDLE hCard; + DWORD dwActiveProtocol; + const SCARD_IO_REQUEST *pioSendPci; + SCARD_IO_REQUEST pioRecvPci; + char *name; +}; + +static struct osim_reader_hdl *pcsc_reader_open(int num, const char *id, void *ctx) +{ + struct osim_reader_hdl *rh; + struct pcsc_reader_state *st; + long rc; + LPSTR mszReaders = NULL; + DWORD dwReaders; + unsigned int num_readers; + char *ptr; + + /* FIXME: implement matching on id or num */ + + rh = talloc_zero(ctx, struct osim_reader_hdl); + st = rh->priv = talloc_zero(rh, struct pcsc_reader_state); + + rc = SCardEstablishContext(SCARD_SCOPE_SYSTEM, NULL, NULL, + &st->hContext); + if (rc != SCARD_S_SUCCESS) + goto end; + + dwReaders = SCARD_AUTOALLOCATE; + rc = SCardListReaders(st->hContext, NULL, (LPSTR)&mszReaders, &dwReaders); + PCSC_ERROR(rc, "SCardListReaders"); + + num_readers = 0; + ptr = mszReaders; + while (*ptr != '\0') { + ptr += strlen(ptr)+1; + num_readers++; + } + + if (num_readers == 0) + goto end; + + st->name = talloc_strdup(rh, mszReaders); + st->dwActiveProtocol = -1; + + return rh; +end: + talloc_free(rh); + return NULL; +} + +static struct osim_card_hdl *pcsc_card_open(struct osim_reader_hdl *rh) +{ + struct pcsc_reader_state *st = rh->priv; + struct osim_card_hdl *card; + struct osim_chan_hdl *chan; + int rc; + + rc = SCardConnect(st->hContext, st->name, SCARD_SHARE_SHARED, + SCARD_PROTOCOL_T0, &st->hCard, &st->dwActiveProtocol); + PCSC_ERROR(rc, "SCardConnect"); + + st->pioSendPci = SCARD_PCI_T0; + + card = talloc_zero(rh, struct osim_card_hdl); + INIT_LLIST_HEAD(&card->channels); + card->reader = rh; + rh->card = card; + + /* create a default channel */ + chan = talloc_zero(card, struct osim_chan_hdl); + chan->card = card; + llist_add(&chan->list, &card->channels); + + return card; + +end: + return NULL; +} + + +static int pcsc_transceive(struct osim_reader_hdl *rh, struct msgb *msg) +{ + struct pcsc_reader_state *st = rh->priv; + DWORD rlen = msgb_tailroom(msg); + int rc; + + printf("TX: %s\n", osmo_hexdump(msg->data, msg->len)); + + rc = SCardTransmit(st->hCard, st->pioSendPci, msg->data, msgb_length(msg), + &st->pioRecvPci, msg->tail, &rlen); + PCSC_ERROR(rc, "SCardEndTransaction"); + + printf("RX: %s\n", osmo_hexdump(msg->tail, rlen)); + msgb_put(msg, rlen); + msgb_apdu_le(msg) = rlen; + + return 0; +end: + return -EIO; +} + +const struct osim_reader_ops pcsc_reader_ops = { + .name = "PC/SC", + .reader_open = pcsc_reader_open, + .card_open = pcsc_card_open, + .transceive = pcsc_transceive, +}; + diff --git a/src/sim/sim_int.h b/src/sim/sim_int.h new file mode 100644 index 00000000..411c3225 --- /dev/null +++ b/src/sim/sim_int.h @@ -0,0 +1,38 @@ +#ifndef _SIM_INT_H + +#include + +struct osim_decoded_element * +element_alloc(struct osim_decoded_data *dd, const char *name, + enum osim_element_type type, enum osim_element_repr repr); + +struct osim_decoded_element * +element_alloc_sub(struct osim_decoded_element *ee, const char *name, + enum osim_element_type type, enum osim_element_repr repr); + +extern const struct osim_card_sw ts102221_uicc_sw[0]; + + +void add_filedesc(struct osim_file_desc *root, const struct osim_file_desc *in, int num); +struct osim_file_desc *alloc_df(void *ctx, uint16_t fid, const char *name); +struct osim_file_desc * +add_df_with_ef(struct osim_file_desc *parent, + uint16_t fid, const char *name, + const struct osim_file_desc *in, int num); + +struct osim_file_desc * +add_adf_with_ef(struct osim_file_desc *parent, + const uint8_t *adf_name, uint8_t adf_name_len, + const char *name, const struct osim_file_desc *in, + int num); + +struct osim_reader_ops { + const char *name; + struct osim_reader_hdl *(*reader_open)(int idx, const char *name); + struct osim_card_hdl *(*card_open)(struct osim_reader_hdl *rh); + int (*transceive)(struct osim_reader_hdl *rh, struct msgb *msg); +}; + +const struct osim_reader_ops pcsc_reader_ops; + +#endif -- cgit v1.2.3