diff frbl/test/srecreader.c @ 323:cefa700d1b8f

frbl: beginning of frbl2test
author Mychaela Falconia <falcon@freecalypso.org>
date Thu, 05 Mar 2020 22:05:01 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/frbl/test/srecreader.c	Thu Mar 05 22:05:01 2020 +0000
@@ -0,0 +1,106 @@
+/*
+ * This module contains the functions for reading S-record files.
+ */
+
+#include <sys/types.h>
+#include <stdint.h>
+#include <stdio.h>
+#include <ctype.h>
+#include <strings.h>
+#include "srecreader.h"
+
+open_srec_file(sr)
+	struct srecreader *sr;
+{
+	sr->openfile = fopen(sr->filename, "r");
+	if (!sr->openfile) {
+		perror(sr->filename);
+		return(-1);
+	}
+	sr->lineno = 0;
+	return(0);
+}
+
+static
+srec2bin(sr, asciiline)
+	struct srecreader *sr;
+	char *asciiline;
+{
+	register int i, l, b;
+
+	l = decode_hex_byte(asciiline + 2);
+	if (l < 1) {
+		fprintf(stderr, "%s line %d: S-record length octet is bad\n",
+			sr->filename, sr->lineno);
+		return(-1);
+	}
+	sr->record[0] = l;
+	for (i = 1; i <= l; i++) {
+		b = decode_hex_byte(asciiline + i*2 + 2);
+		if (b < 0) {
+			fprintf(stderr,
+				"%s line %d: S-record hex decode error\n",
+				sr->filename, sr->lineno);
+			return(-1);
+		}
+		sr->record[i] = b;
+	}
+	return(0);
+}
+
+static
+srec_cksum(sr)
+	struct srecreader *sr;
+{
+	u_char accum;
+	register int i, len;
+
+	len = sr->record[0] + 1;
+	accum = 0;
+	for (i = 0; i < len; i++)
+		accum += sr->record[i];
+	if (accum != 0xFF) {
+		fprintf(stderr, "%s line %d: bad S-record checksum\n",
+			sr->filename, sr->lineno);
+		return(-1);
+	}
+	return(0);
+}
+
+read_s_record(sr)
+	struct srecreader *sr;
+{
+	char asciiline[1024];
+
+	if (!fgets(asciiline, sizeof asciiline, sr->openfile)) {
+		fprintf(stderr, "%s: premature EOF after %d S-records\n",
+			sr->filename, sr->lineno);
+		return(-1);
+	}
+	sr->lineno++;
+	if (asciiline[0] != 'S' || !isdigit(asciiline[1])) {
+		fprintf(stderr, "%s line %d: S-record expected\n",
+			sr->filename, sr->lineno);
+		return(-1);
+	}
+	sr->record_type = asciiline[1];
+	if (srec2bin(sr, asciiline) < 0)
+		return(-1);
+	return srec_cksum(sr);
+}
+
+s3s7_get_addr_data(sr)
+	struct srecreader *sr;
+{
+	if (sr->record[0] < 5) {
+		fprintf(stderr, "%s line %d: S%c record is too short\n",
+			sr->filename, sr->lineno, sr->record_type);
+		return(-1);
+	}
+	sr->datalen = sr->record[0] - 5;
+	sr->addr = ((uint32_t)sr->record[1] << 24) |
+		   ((uint32_t)sr->record[2] << 16) |
+		   ((uint32_t)sr->record[3] << 8) |
+		    (uint32_t)sr->record[4];
+	return(0);
+}