view simtool/miscadm.c @ 181:63b640562e21

simtool/miscadm.c: code refactoring in preparation for adding shorthand ICCID and IMSI write commands
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 06 Mar 2021 04:51:56 +0000
parents 105aa3d1a494
children f4edccd4b583
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);
}

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);
}