FreeCalypso > hg > fc-sim-tools
diff simtool/miscadm.c @ 10:ddd767f6e15b
fc-simtool ported over
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 14 Mar 2021 07:11:25 +0000 |
parents | |
children | 1888d88478c4 |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/simtool/miscadm.c Sun Mar 14 07:11:25 2021 +0000 @@ -0,0 +1,216 @@ +/* + * This module implements write-iccid and write-imsi commands, + * available only in the admin programming phase after authenticating + * with some card-vendor-dependent ADM key. + */ + +#include <sys/types.h> +#include <stdio.h> +#include <stdlib.h> +#include <string.h> +#include <strings.h> +#include "curfile.h" +#include "file_id.h" + +static +write_iccid_bin(binrec) + u_char *binrec; +{ + int rc; + + rc = select_op(FILEID_MF); + if (rc < 0) + return(rc); + rc = select_op(EF_ICCID); + if (rc < 0) + return(rc); + rc = parse_ef_select_response(); + if (rc < 0) + return(rc); + if (curfile_structure != 0x00 || curfile_total_size != 10) { + fprintf(stderr, + "error: EF_ICCID is not a transparent EF of 10 bytes\n"); + return(-1); + } + return update_bin_op(0, binrec, 10); +} + +cmd_write_iccid(argc, argv) + char **argv; +{ + int rc; + u_char nibbles[20], binrec[10]; + + rc = parse_decimal_string_arg(argv[1], nibbles, 20); + if (rc < 0) + return(rc); + pack_reversed_nibbles(nibbles, binrec, 10); + return write_iccid_bin(binrec); +} + +cmd_write_iccid_sh18(argc, argv) + char **argv; +{ + int rc; + u_char nibbles[20], binrec[10]; + + rc = parse_decimal_shorthand(argv[1], nibbles, 18); + if (rc < 0) + return(rc); + nibbles[18] = compute_iccid_luhn(nibbles); + nibbles[19] = 0xF; + pack_reversed_nibbles(nibbles, binrec, 10); + return write_iccid_bin(binrec); +} + +cmd_write_iccid_sh19(argc, argv) + char **argv; +{ + int rc; + u_char nibbles[20], binrec[10]; + + rc = parse_decimal_shorthand(argv[1], nibbles, 19); + if (rc < 0) + return(rc); + if (nibbles[18] != compute_iccid_luhn(nibbles)) { + fprintf(stderr, "error: Luhn check digit mismatch\n"); + return(-1); + } + nibbles[19] = 0xF; + pack_reversed_nibbles(nibbles, binrec, 10); + return write_iccid_bin(binrec); +} + +static +write_imsi_bin(binrec) + u_char *binrec; +{ + int rc; + + rc = select_op(DF_GSM); + if (rc < 0) + return(rc); + rc = select_op(EF_IMSI); + if (rc < 0) + return(rc); + rc = parse_ef_select_response(); + if (rc < 0) + return(rc); + if (curfile_structure != 0x00 || curfile_total_size != 9) { + fprintf(stderr, + "error: EF_IMSI is not a transparent EF of 9 bytes\n"); + return(-1); + } + return update_bin_op(0, binrec, 9); +} + +cmd_write_imsi(argc, argv) + char **argv; +{ + int rc; + u_char nibbles[16], binrec[9]; + unsigned ndig; + + rc = parse_decimal_string_arg(argv[1], nibbles + 1, 15); + if (rc < 0) + return(rc); + ndig = rc; + if (ndig & 1) + nibbles[0] = 9; + else + nibbles[0] = 1; + binrec[0] = (ndig + 2) >> 1; + pack_reversed_nibbles(nibbles, binrec + 1, 8); + return write_imsi_bin(binrec); +} + +cmd_write_imsi_sh(argc, argv) + char **argv; +{ + int rc; + u_char nibbles[16], binrec[9]; + + rc = parse_decimal_shorthand(argv[1], nibbles + 1, 15); + if (rc < 0) + return(rc); + nibbles[0] = 9; + binrec[0] = 8; + pack_reversed_nibbles(nibbles, binrec + 1, 8); + return write_imsi_bin(binrec); +} + +static +write_acc_bin(binrec) + u_char *binrec; +{ + int rc; + + rc = select_op(DF_GSM); + if (rc < 0) + return(rc); + rc = select_op(EF_ACC); + if (rc < 0) + return(rc); + rc = parse_ef_select_response(); + if (rc < 0) + return(rc); + if (curfile_structure != 0x00 || curfile_total_size != 2) { + fprintf(stderr, + "error: EF_ACC is not a transparent EF of 2 bytes\n"); + return(-1); + } + return update_bin_op(0, binrec, 2); +} + +cmd_write_acc(argc, argv) + char **argv; +{ + unsigned acc; + u_char binrec[2]; + + acc = strtoul(argv[1], 0, 16); + if (acc > 0xFFFF) { + fprintf(stderr, "error: ACC argument is out of range\n"); + return(-1); + } + binrec[0] = acc >> 8; + binrec[1] = acc; + return write_acc_bin(binrec); +} + +static +write_spn_bin(binrec) + u_char *binrec; +{ + int rc; + + rc = select_op(DF_GSM); + if (rc < 0) + return(rc); + rc = select_op(EF_SPN); + if (rc < 0) + return(rc); + rc = parse_ef_select_response(); + if (rc < 0) + return(rc); + if (curfile_structure != 0x00 || curfile_total_size != 17) { + fprintf(stderr, + "error: EF_SPN is not a transparent EF of 17 bytes\n"); + return(-1); + } + return update_bin_op(0, binrec, 17); +} + +cmd_write_spn(argc, argv) + char **argv; +{ + u_char binrec[17]; + int rc; + + binrec[0] = strtoul(argv[1], 0, 16); + memset(binrec + 1, 0xFF, 16); + rc = qstring_arg_to_gsm7(argv[2], binrec + 1, 16); + if (rc < 0) + return(rc); + return write_spn_bin(binrec); +}