view simtool/pnndump.c @ 103:9b2cb2b9c910

fc-simtool fplmn-* commands implemented
author Mychaela Falconia <falcon@freecalypso.org>
date Thu, 18 Feb 2021 00:17:14 +0000
parents dc8a2e6fa03e
children 2c07684a3980
line wrap: on
line source

/*
 * This module implements the pnn-dump command, providing a
 * user-accessible way to identify MVNO SIMs.
 */

#include <sys/types.h>
#include <stdio.h>
#include "simresp.h"
#include "curfile.h"
#include "file_id.h"

static void
dump_record(recno)
	unsigned recno;
{
	u_char *dp, *endp;
	char *name_kw;
	unsigned ielen, code_byte, nsept;
	u_char gsm7_buf[288];

	printf("#%u:", recno);
	dp = sim_resp_data;
	endp = sim_resp_data + sim_resp_data_len;
	while (dp < endp) {
		if (*dp == 0xFF)
			break;
		switch (*dp++) {
		case 0x43:
			name_kw = "Ln";
			break;
		case 0x45:
			name_kw = "Sn";
			break;
		default:
			printf(" unknown-IEI\n");
			return;
		}
		if (dp >= endp) {
			printf(" truncated-IE\n");
			return;
		}
		ielen = *dp++;
		if (ielen < 1 || ielen > (endp - dp)) {
			printf(" bad-length\n");
			return;
		}
		code_byte = *dp++;
		ielen--;
		printf(" %s=0x%02X", name_kw, code_byte);
		if (!ielen)
			continue;
		putchar(',');
		if ((code_byte & 0x70) == 0) {
			nsept = ielen * 8 / 7;
			gsm7_unpack(dp, gsm7_buf, nsept);
			dp += ielen;
			print_gsm7_string_to_file(gsm7_buf, nsept, stdout);
		} else {
			for (; ielen; ielen--)
				printf("%02X", *dp++);
		}
	}
	for (; dp < endp; dp++) {
		if (*dp != 0xFF) {
			printf(" bad-padding\n");
			return;
		}
	}
	putchar('\n');
}

cmd_pnn_dump()
{
	int rc;
	unsigned recno;

	rc = select_op(DF_GSM);
	if (rc < 0)
		return(rc);
	rc = select_op(EF_PNN);
	if (rc < 0)
		return(rc);
	rc = parse_ef_select_response();
	if (rc < 0)
		return(rc);
	if (curfile_structure != 0x01) {
		fprintf(stderr, "error: EF_PNN is not linear fixed\n");
		return(-1);
	}
	if (curfile_record_len < 3) {
		fprintf(stderr,
"error: EF_PNN record length is less than the spec minimum of 3 bytes\n");
		return(-1);
	}
	for (recno = 1; recno <= curfile_record_count; recno++) {
		rc = readrec_op(recno, 0x04, curfile_record_len);
		if (rc < 0)
			return(rc);
		if (check_simresp_all_blank())
			continue;
		dump_record(recno);
	}
	return(0);
}