changeset 91:abef3d5668b9

fc-uicc-tool: restore-file ported over from fc-simtool
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 11 Apr 2021 04:44:34 +0000
parents 3afa61d98961
children 5560261fc516
files uicc/Makefile uicc/cmdtab.c uicc/restorebin.c
diffstat 3 files changed, 147 insertions(+), 2 deletions(-) [+]
line wrap: on
line diff
--- a/uicc/Makefile	Sun Apr 11 04:32:26 2021 +0000
+++ b/uicc/Makefile	Sun Apr 11 04:44:34 2021 +0000
@@ -3,8 +3,8 @@
 CPPFLAGS=-I../libcommon
 PROG=	fc-uicc-tool
 OBJS=	bfsearch.o cmdtab.o createfile.o dumpdir.o getresp.o hlread.o main.o \
-	pins.o readcmd.o readef.o readops.o savebin.o select.o sws.o writecmd.o\
-	writeops.o
+	pins.o readcmd.o readef.o readops.o restorebin.o savebin.o select.o \
+	sws.o writecmd.o writeops.o
 LIBS=	../libcommon/libcommon.a ../libutil/libutil.a
 
 INSTALL_PREFIX=	/opt/freecalypso
--- a/uicc/cmdtab.c	Sun Apr 11 04:32:26 2021 +0000
+++ b/uicc/cmdtab.c	Sun Apr 11 04:44:34 2021 +0000
@@ -25,6 +25,7 @@
 extern int cmd_readbin();
 extern int cmd_readef();
 extern int cmd_readrec();
+extern int cmd_restore_file();
 extern int cmd_savebin();
 extern int cmd_select();
 extern int cmd_select_aid();
@@ -67,6 +68,7 @@
 	{"readbin", 2, 2, 1, cmd_readbin},
 	{"readef", 1, 1, 1, cmd_readef},
 	{"readrec", 1, 2, 1, cmd_readrec},
+	{"restore-file", 2, 2, 0, cmd_restore_file},
 	{"savebin", 2, 2, 0, cmd_savebin},
 	{"select", 1, 1, 1, cmd_select},
 	{"select-aid", 1, 1, 1, cmd_select_aid},
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/uicc/restorebin.c	Sun Apr 11 04:44:34 2021 +0000
@@ -0,0 +1,143 @@
+/*
+ * This module implements the restore-file command; this command
+ * reads binary files previously saved with the savebin command
+ * and writes the backed-up bits back to the SIM.
+ */
+
+#include <sys/types.h>
+#include <sys/file.h>
+#include <sys/stat.h>
+#include <ctype.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include "efstruct.h"
+
+static
+restore_bin_transparent(efs, data)
+	struct ef_struct *efs;
+	u_char *data;
+{
+	unsigned off, cc;
+	int rc;
+
+	for (off = 0; off < efs->total_size; off += cc) {
+		cc = efs->total_size - off;
+		if (cc > 255)
+			cc = 255;
+		rc = update_bin_op(off, data + off, cc);
+		if (rc < 0)
+			return(rc);
+	}
+	return(0);
+}
+
+static
+restore_bin_records(efs, data)
+	struct ef_struct *efs;
+	u_char *data;
+{
+	unsigned recno;
+	u_char *dp;
+	int rc;
+
+	dp = data;
+	for (recno = 1; recno <= efs->record_count; recno++) {
+		rc = update_rec_op(recno, 0x04, dp, efs->record_len);
+		if (rc < 0)
+			return(rc);
+		dp += efs->record_len;
+	}
+	return(0);
+}
+
+static
+restore_bin_cyclic(efs, data)
+	struct ef_struct *efs;
+	u_char *data;
+{
+	unsigned count;
+	u_char *dp;
+	int rc;
+
+	dp = data + efs->total_size;
+	for (count = 0; count < efs->record_count; count++) {
+		dp -= efs->record_len;
+		rc = update_rec_op(0, 0x03, dp, efs->record_len);
+		if (rc < 0)
+			return(rc);
+	}
+	return(0);
+}
+
+cmd_restore_file(argc, argv)
+	char **argv;
+{
+	int file_id, rc, fd;
+	struct ef_struct efs;
+	struct stat st;
+	u_char *databuf;
+
+	if (isxdigit(argv[1][0]) && isxdigit(argv[1][1]) &&
+	    isxdigit(argv[1][2]) && isxdigit(argv[1][3]) && !argv[1][4])
+		file_id = strtoul(argv[1], 0, 16);
+	else
+		file_id = find_symbolic_file_name(argv[1]);
+	if (file_id < 0) {
+		fprintf(stderr,
+"error: file ID argument is not a hex value or a recognized symbolic name\n");
+		return(-1);
+	}
+	rc = select_op(file_id);
+	if (rc < 0)
+		return(rc);
+	rc = select_resp_get_ef_struct(&efs);
+	if (rc < 0)
+		return(rc);
+	if (!efs.total_size) {
+		printf("SIM indicates file of zero length, nothing to do\n");
+		return(0);
+	}
+	fd = open(argv[2], O_RDONLY);
+	if (fd < 0) {
+		perror(argv[2]);
+		return(-1);
+	}
+	fstat(fd, &st);
+	if ((st.st_mode & S_IFMT) != S_IFREG) {
+		fprintf(stderr, "error: %s is not a regular file\n", argv[2]);
+		close(fd);
+		return(-1);
+	}
+	if (st.st_size != efs.total_size) {
+		fprintf(stderr,
+	"error: length of %s does not match SIM EF length of %u bytes\n",
+			argv[2], efs.total_size);
+		close(fd);
+		return(-1);
+	}
+	databuf = malloc(efs.total_size);
+	if (!databuf) {
+		perror("malloc for file data");
+		close(fd);
+		return(-1);
+	}
+	read(fd, databuf, efs.total_size);
+	close(fd);
+	switch (efs.structure) {
+	case 0x01:
+		/* transparent */
+		rc = restore_bin_transparent(&efs, databuf);
+		break;
+	case 0x02:
+		/* record-based */
+		rc = restore_bin_records(&efs, databuf);
+		break;
+	case 0x06:
+		/* cyclic */
+		rc = restore_bin_cyclic(&efs, databuf);
+		break;
+	}
+	free(databuf);
+	return(rc);
+}