# HG changeset patch
# User Mychaela Falconia <falcon@freecalypso.org>
# Date 1591343673 0
# Node ID cf7bd5e705edcd6bb848f14c9a1ee182efcafe8d
# Parent  a167d7b376b71a3072b23932eb043bfc038e4512
fc-loadtool: flash compal-imei command implemented

diff -r a167d7b376b7 -r cf7bd5e705ed loadtools/flmain.c
--- a/loadtools/flmain.c	Fri Jun 05 07:29:59 2020 +0000
+++ b/loadtools/flmain.c	Fri Jun 05 07:54:33 2020 +0000
@@ -92,6 +92,7 @@
 }
 
 extern int flashcmd_blankchk();
+extern int flashcmd_compal_imei();
 extern int flashcmd_dump2file();
 extern int flashcmd_erase();
 extern int flashcmd_erase_program_boot();
@@ -110,6 +111,7 @@
 	int (*func)();
 } cmdtab[] = {
 	{"blankchk", flashcmd_blankchk},
+	{"compal-imei", flashcmd_compal_imei},
 	{"dump2bin", flashcmd_dump2file},
 	{"dump2srec", flashcmd_dump2file},
 	{"erase", flashcmd_erase},
diff -r a167d7b376b7 -r cf7bd5e705ed loadtools/flprotreg.c
--- a/loadtools/flprotreg.c	Fri Jun 05 07:29:59 2020 +0000
+++ b/loadtools/flprotreg.c	Fri Jun 05 07:54:33 2020 +0000
@@ -37,3 +37,93 @@
 		data[8]);
 	return(0);
 }
+
+static int
+compute_cd(digits)
+	u_char *digits;
+{
+	int i, dig, sum;
+
+	sum = 0;
+	for (i = 0; i < 14; i++) {
+		dig = digits[i];
+		if (i & 1) {
+			dig *= 2;
+			if (dig > 9)
+				dig -= 9;
+		}
+		sum += dig;
+	}
+	dig = sum % 10;
+	if (dig)
+		dig = 10 - dig;
+	return dig;
+}
+
+static void
+format_imei(digits, strout)
+	u_char *digits;
+	char *strout;
+{
+	int i;
+	char *dp;
+
+	dp = strout;
+	for (i = 0; i < 15; i++) {
+		if (i == 8 || i == 14)
+			*dp++ = '-';
+		*dp++ = digits[i] + '0';
+	}
+	*dp = '\0';
+}
+
+flashcmd_compal_imei(argc, argv, bank)
+	char **argv;
+{
+	struct flash_bank_info *bi;
+	uint16_t data[9];
+	u_char nibbles[16], *dp;
+	char imei_str[18];
+	int rc, i, j;
+	FILE *of;
+
+	if (argc > 3) {
+		fprintf(stderr, "error: too many arguments\n");
+		return(-1);
+	}
+	if (flash_detect(bank, 0) < 0)
+		return(-1);
+	bi = flash_bank_info + bank;
+	rc = bi->ops->read_prot_reg(bi, data);
+	if (rc)
+		return(rc);
+	dp = nibbles;
+	for (i = 0; i < 4; i++) {
+		rc = data[i + 5];
+		for (j = 0; j < 4; j++) {
+			*dp++ = rc & 0xF;
+			rc >>= 4;
+		}
+	}
+	for (i = 1; i < 16; i++) {
+		if (nibbles[i] > 9) {
+bad_imei:		fprintf(stderr, "No Compal IMEI found\n");
+			return(-1);
+		}
+	}
+	if (compute_cd(nibbles+1) != nibbles[15])
+		goto bad_imei;
+	format_imei(nibbles+1, imei_str);
+	puts(imei_str);
+	if (argc < 3)
+		return(0);
+	of = fopen(argv[2], "w");
+	if (!of) {
+		perror(argv[2]);
+		return(-1);
+	}
+	fprintf(of, "%s\n", imei_str);
+	fclose(of);
+	printf("Saved to %s\n", argv[2]);
+	return(0);
+}