/* SPDX-License-Identifier: GPL-2.0-only */

#include <stdio.h>
#include <stdlib.h>

static void usage(const char *s)
{
	printf("insert firmware blobs:\n\t"
	       "%s <rom file> <fw1> <fw2> <fw1 offset> <fw2 offset>\n\n",
	       s);
	printf("set addresses of firmware blobs only:\n\t"
	       "%s <rom file> <fw1 offset> <fw2 offset>\n\n",
	       s);
	printf(
	    "offset can be (example is put it to 0x7ffa00 when ROM is 8MB):\n"
	    "- file offset: 0x7ffa00\n"
	    "- distance to the end of file: -0x600\n"
	    "- the address when ROM is mapped to the end of memory: "
	    "0xfffffa00\n");
	exit(1);
}

static void FseekEnd(FILE *fp, long o)
{
	if (fseek(fp, o, SEEK_END) != 0) {
		puts("fseek() error!\n");
		exit(1);
	}
}

static long negoffset(long a, long romsz)
{
	if (a > 0) {
		if (a & 0x80000000) /* the address in memory, and sizeof(long)
				       is 8 */
			return a - 0x100000000;
		else /* the file offset */
			return a - romsz;
	} else {
		return a;
	}
}

int main(int argc, char *argv[])
{
	FILE *fp, *fw1, *fw2;
	long offset1, offset2;

	if (argc != 4 && argc != 6)
		usage(argv[0]);

	fp = fopen(argv[1], "rb+");
	if (fp == NULL) {
		puts("Error opening firmware image!");
		exit(1);
	}

	if (argc == 6) {
		fw1 = fopen(argv[2], "rb");
		fw2 = fopen(argv[3], "rb");
		offset1 = strtoul(argv[4], NULL, 0);
		offset2 = strtoul(argv[5], NULL, 0);

		if (fw1 == NULL || fw2 == NULL) {
			puts("Error opening file!");
			exit(1);
		}
	} else {
		fw1 = NULL;
		fw2 = NULL;
		offset1 = strtoul(argv[2], NULL, 0);
		offset2 = strtoul(argv[3], NULL, 0);
	}

	if ((offset1 & 0xff) || (offset2 & 0xff)) {
		puts("The offsets must be aligned to 0x100");
		exit(1);
	}

	long romsz;
	FseekEnd(fp, -1);
	romsz = ftell(fp) + 1;
	printf("size of %s: 0x%lx\n", argv[1], romsz);

	if (romsz & 0xff) {
		puts("The ROM size must be multiple of 0x100");
		exit(1);
	}

	offset1 = negoffset(offset1, romsz);
	offset2 = negoffset(offset2, romsz);

	/* write two offsets to $s-0x100 */
	char offs[8];
	long os;
	os = 0x1000000 + offset1;
	offs[0] = os >> 16;
	offs[1] = os >> 8;
	offs[2] = 0xff - offs[0];
	offs[3] = 0xff - offs[1];
	os = 0x1000000 + offset2;
	offs[4] = os >> 16;
	offs[5] = os >> 8;
	offs[6] = 0xff - offs[4];
	offs[7] = 0xff - offs[5];
	for (size_t i = 0; i < 8; i++)
		printf("%02hhx ", offs[i]);

	puts("");
	FseekEnd(fp, -0x100);
	printf("writing to 0x%lx\n", ftell(fp));
	fwrite(offs, 1, 8, fp);

	if (argc == 6) {
		/* write fw1 and fw2 */
		char c;
		FseekEnd(fp, offset1);
		printf("writing to 0x%lx\n", ftell(fp));
		while (fread(&c, 1, 1, fw1) == 1)
			fwrite(&c, 1, 1, fp);

		FseekEnd(fp, offset2);
		printf("writing to 0x%lx\n", ftell(fp));
		while (fread(&c, 1, 1, fw2) == 1)
			fwrite(&c, 1, 1, fp);

		fclose(fw1);
		fclose(fw2);
	}

	fclose(fp);
	return 0;
}