view simtool/pbdump.c @ 110:a6de34816297

fc-simtool: EXT field handling bugfix in pb-dump
author Mychaela Falconia <falcon@freecalypso.org>
date Tue, 26 Jan 2021 02:52:44 +0000
parents 66f04193a906
children f18704e91393
line wrap: on
line source

/*
 * This module implements the pb-dump command.
 */

#include <sys/types.h>
#include <string.h>
#include <strings.h>
#include <stdio.h>
#include <stdlib.h>
#include <pcsclite.h>
#include <winscard.h>
#include "globals.h"

static char gsm_address_digits[16] =
	{'0','1','2','3','4','5','6','7','8','9','*','#','a','b','c','?'};

static
check_all_blank()
{
	u_char *dp, *endp;

	dp = sim_resp_data;
	endp = sim_resp_data + sim_resp_data_len;
	while (dp < endp)
		if (*dp++ != 0xFF)
			return(0);
	return(1);
}

static
decode_number(data, nbytes, out)
	u_char *data;
	unsigned nbytes;
	char *out;
{
	u_char *dp, *endp;
	int c;

	dp = data;
	endp = data + nbytes;
	while (dp < endp) {
		c = *dp & 0xF;
		if (c == 0xF)
			return(-1);
		*out++ = gsm_address_digits[c];
		c = *dp >> 4;
		if (c == 0xF) {
			if (dp + 1 == endp)
				break;
			else
				return(-1);
		}
		*out++ = gsm_address_digits[c];
		dp++;
	}
	*out = '\0';
	return(0);
}

static
check_blank_area(dp, endp)
	u_char *dp, *endp;
{
	while (dp < endp)
		if (*dp++ != 0xFF)
			return(-1);
	return(0);
}

static void
dump_record(recno, outf)
	unsigned recno;
	FILE *outf;
{
	int rc;
	unsigned textlen;
	u_char *fixp;
	char digits[21];

	fprintf(outf, "#%u: ", recno);
	if (curfile_record_len > 14) {
		rc = validate_alpha_field(sim_resp_data,
					  curfile_record_len - 14,
					  &textlen);
		if (rc < 0) {
malformed:		fprintf(outf, "malformed record\n");
			return;
		}
	} else
		textlen = 0;
	fixp = sim_resp_data + sim_resp_data_len - 14;
	if (fixp[0] < 2 || fixp[0] > 11)
		goto malformed;
	rc = decode_number(fixp + 2, fixp[0] - 1, digits);
	if (rc < 0)
		goto malformed;
	rc = check_blank_area(fixp + 1 + fixp[0], fixp + 12);
	if (rc < 0)
		goto malformed;
	/* all checks passed */
	fprintf(outf, "%s,0x%02X ", digits, fixp[1]);
	if (fixp[12] != 0xFF)
		fprintf(outf, "CCP=%u ", fixp[12]);
	if (fixp[13] != 0xFF)
		fprintf(outf, "EXT=%u ", fixp[13]);
	print_alpha_field(sim_resp_data, textlen, outf);
	putc('\n', outf);
}

cmd_pb_dump(argc, argv)
	char **argv;
{
	int rc;
	FILE *outf;
	unsigned recno;

	rc = phonebook_op_common(argv[1]);
	if (rc < 0)
		return(rc);
	if (argv[2]) {
		outf = fopen(argv[2], "w");
		if (!outf) {
			perror(argv[2]);
			return(-1);
		}
	} else
		outf = stdout;
	for (recno = 1; recno <= curfile_record_count; recno++) {
		rc = readrec_op(recno, 0x04, curfile_record_len);
		if (rc < 0) {
			if (argv[2])
				fclose(outf);
			return(rc);
		}
		if (check_all_blank())
			continue;
		dump_record(recno, outf);
	}
	if (argv[2])
		fclose(outf);
	return(0);
}