diff simtool/pnnprog.c @ 10:ddd767f6e15b

fc-simtool ported over
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 14 Mar 2021 07:11:25 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/simtool/pnnprog.c	Sun Mar 14 07:11:25 2021 +0000
@@ -0,0 +1,111 @@
+/*
+ * This module implements functions for admin programming of EF_PNN.
+ */
+
+#include <sys/types.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <strings.h>
+#include "curfile.h"
+
+static u_char *
+add_field(dp, bytes_avail, namearg, type)
+	u_char *dp;
+	char *namearg;
+	unsigned bytes_avail, type;
+{
+	u_char gsm7_buf[289];
+	unsigned nsept, noct;
+	int rc;
+
+	if (bytes_avail < 4) {
+		fprintf(stderr,
+			"error: PNN record is too short for name element\n");
+		return(0);
+	}
+	rc = qstring_arg_to_gsm7(namearg, gsm7_buf, (bytes_avail-3) * 8 / 7);
+	if (rc < 0)
+		return(0);
+	nsept = rc;
+	gsm7_buf[nsept] = 0;
+	noct = (nsept * 7 + 7) / 8;
+	*dp++ = type;
+	*dp++ = noct + 1;
+	*dp++ = 0x80 | (nsept & 7);
+	gsm7_pack(gsm7_buf, dp, noct);
+	dp += noct;
+	return dp;
+}
+
+cmd_pnn_write(argc, argv)
+	char **argv;
+{
+	int rc;
+	unsigned recno;
+	u_char record[255], *dp, *endp;
+
+	rc = select_ef_pnn();
+	if (rc < 0)
+		return(rc);
+	recno = strtoul(argv[1], 0, 0);
+	if (recno < 1 || recno > curfile_record_count) {
+		fprintf(stderr, "error: specified record number is invalid\n");
+		return(-1);
+	}
+	dp = record;
+	endp = record + curfile_record_len;
+	dp = add_field(dp, endp - dp, argv[2], 0x43);
+	if (!dp)
+		return(-1);
+	if (argv[3]) {
+		dp = add_field(dp, endp - dp, argv[3], 0x45);
+		if (!dp)
+			return(-1);
+	}
+	while (dp < endp)
+		*dp++ = 0xFF;
+	return update_rec_op(recno, 0x04, record, curfile_record_len);
+}
+
+cmd_pnn_erase(argc, argv)
+	char **argv;
+{
+	int rc;
+	unsigned recno, startrec, endrec;
+	u_char record[255];
+
+	rc = select_ef_pnn();
+	if (rc < 0)
+		return(rc);
+	startrec = strtoul(argv[1], 0, 0);
+	if (startrec < 1 || startrec > curfile_record_count) {
+		fprintf(stderr,
+			"error: specified starting record number is invalid\n");
+		return(-1);
+	}
+	if (!argv[2])
+		endrec = startrec;
+	else if (!strcmp(argv[2], "end"))
+		endrec = curfile_record_count;
+	else {
+		endrec = strtoul(argv[2], 0, 0);
+		if (endrec < 1 || endrec > curfile_record_count) {
+			fprintf(stderr,
+			"error: specified final record number is invalid\n");
+			return(-1);
+		}
+		if (startrec > endrec) {
+			fprintf(stderr,
+				"error: reverse record range specified\n");
+			return(-1);
+		}
+	}
+	memset(record, 0xFF, curfile_record_len);
+	for (recno = startrec; recno <= endrec; recno++) {
+		rc = update_rec_op(recno, 0x04, record, curfile_record_len);
+		if (rc < 0)
+			return(rc);
+	}
+	return(0);
+}