From 0e4f426dfbdacc6977ccf51f4e3f81e62943226f Mon Sep 17 00:00:00 2001
From: Ondrej Jirman <megous@megous.com>
Date: Tue, 31 Aug 2021 14:29:21 +0200
Subject: [PATCH] Add bin2pgd tool

This is used by the vendor's flashing tool. It's ROM image + option
ROM image appended (256 bytes).

Option ROM contains some flags and configuration data for the MCU.
Things like oscillator configuration, HW reset pin enable, data EEPROM
enable, etc.
---
 bin2pgd.c | 91 +++++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 91 insertions(+)
 create mode 100644 bin2pgd.c

diff --git a/bin2pgd.c b/bin2pgd.c
new file mode 100644
index 0000000..75b51ac
--- /dev/null
+++ b/bin2pgd.c
@@ -0,0 +1,91 @@
+#include <assert.h>
+#include <errno.h>
+#include <fcntl.h>
+#include <inttypes.h>
+#include <stdarg.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <sys/stat.h>
+#include <time.h>
+#include <poll.h>
+#include <sys/ioctl.h>
+#include <unistd.h>
+#include <sys/types.h>
+#include <dirent.h>
+#include <getopt.h>
+
+static void syscall_error(int is_err, const char* fmt, ...)
+{
+	va_list ap;
+
+	if (!is_err)
+		return;
+
+	fprintf(stderr, "ERROR: ");
+	va_start(ap, fmt);
+	vfprintf(stderr, fmt, ap);
+	va_end(ap);
+	fprintf(stderr, ": %s\n", strerror(errno));
+
+	exit(1);
+}
+
+static void error(const char* fmt, ...)
+{
+	va_list ap;
+
+	fprintf(stderr, "ERROR: ");
+	va_start(ap, fmt);
+	vfprintf(stderr, fmt, ap);
+	va_end(ap);
+	fprintf(stderr, "\n");
+
+	exit(1);
+}
+
+int main(int ac, char* av[])
+{
+	int fd, ret;
+
+	uint8_t rom[0x8100];
+	memset(rom, 0xff, sizeof rom);
+
+	fd = open(av[1], O_RDONLY);
+	syscall_error(fd < 0, "open(%s) failed", av[1]);
+	ssize_t len = read(fd, rom, 0x8000);
+	syscall_error(len < 0, "read failed");
+	close(fd);
+	if (len != 0x8000)
+		error("Invalid ROM file (%s) size (%d), must be 32768 bytes", av[1], (int)len);
+	
+	uint16_t csum = 0;
+	for (int i = 0x0; i < 0x8000; i++)
+		csum += rom[i];
+
+	uint8_t* opts = rom + 0x8000;
+
+	opts[0] = 0xfc;
+	opts[1] = 0x39;
+	opts[2] = 0x01;
+
+	opts[120] = 0xdf;
+	opts[123] = 0x20;
+	opts[124] = csum;
+	opts[125] = csum >> 8;
+	opts[121] = 0x91 ^ opts[124];
+	opts[122] = 0x0b ^ opts[125];
+	opts[126] = 0x44; // IAP tool identifier (will be overwritten by bootloader to 0x49)
+	opts[127] = 0xaa;
+
+	fd = open(av[2], O_WRONLY | O_CREAT | O_TRUNC, 0666);
+	if (fd >= 0) {
+		ssize_t wr = write(fd, rom, 0x8100);
+		syscall_error(wr < 0, "write failed");
+		close(fd);
+	}
+
+	return 0;
+}