view simtool/miscadm.c @ 182:f4edccd4b583

fc-simtool: write-iccid-sh{18,19} commands implemented
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 06 Mar 2021 05:07:46 +0000
parents 63b640562e21
children 2545dd27ca38
line wrap: on
line source

/*
 * 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 "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);
}