#include <errno.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>

#include "mnemonics.h"

const char *progname;

#define ERROR(...) \
	do { \
		fprintf(stderr, "%s: ", progname); \
		fprintf(stderr, __VA_ARGS__); \
		fprintf(stderr, "\n"); \
	} while (0)

#define PERROR(str) \
	do { \
		int err = errno; \
		fprintf(stderr, "%s: ", progname); \
		errno = err; \
		perror(str); \
	} while (0)

struct line {
	const struct mnemonic *mnem;
	uint16_t addr;
	uint16_t value;
};

static const struct mnemonic *match_instruction(unsigned bits)
{
	for (int i = 0; i < MNEM_LAST; i++) {
		const struct mnemonic *m = mnemonics + i;
		if ((bits & m->mask) == m->bits) return m;
	}
	return NULL;
}

static void print_operand(FILE *out, unsigned bits, const struct operand *op)
{
	switch (op->type) {
	case REG:    fprintf(out,  "r%d",      7 & (bits >> op->shift)); break;
	case REGPTR: fprintf(out, "@r%d",      7 & (bits >> op->shift)); break;
	case IMM:    fprintf(out,   "%d", (uint8_t)(bits >> op->shift)); break;
	case PCOFF:  fprintf(out,   "%d",  (int8_t)(bits >> op->shift)); break;
	}
}

static int resize_lines(struct line **lines, size_t alloc)
{
	struct line *result = realloc(*lines, alloc * sizeof **lines);
	if (result) *lines = result;
	else PERROR("Error allocating memory");
	return !result;
}

static struct line *read_lines(FILE *in, size_t *count)
{
	size_t alloc = 16;
	struct line *lines = NULL;

	*count = 0;
	if (resize_lines(&lines, alloc)) goto fail;

	unsigned bits, addr = 0;
	while (fscanf(in, " %x\n", &bits) > 0) {
		if (addr > 0xffff) {
			ERROR("Input exceeds 16-bit address space");
			goto fail;
		}
		if (*count >= alloc && resize_lines(&lines, alloc *= 2)) {
			goto fail;
		}

		lines[*count] = (struct line) {
			.mnem  = match_instruction(bits),
			.value = bits,
			.addr  = addr,
		};

		addr   += 2;
		*count += 1;
	}

	return lines;

fail:
	free(lines);
	return NULL;
}

static void disassemble(FILE *in, FILE *out)
{
	size_t count;
	struct line *lines = read_lines(in, &count);
	if (!lines) return;

	for (size_t i = 0; i < count; i++) {
		unsigned bits = lines[i].value;
		const struct mnemonic *m = lines[i].mnem;

		if (!m) {
			fprintf(out, "\t.word   0x%04x\n", bits);
			continue;
		}

		fprintf(out, "\t%s", m->mnem);
		for (int i = 0; i < 3 && m->operands[i].type; i++) {
			if (i) fprintf(out, ", ");
			else   fprintf(out, "%*s", 8 - (int)strlen(m->mnem), "");
			print_operand(out, bits, m->operands + i);
		}
		fprintf(out, "\n");
	}

	free(lines);
}

static void usage(const char *progname)
{
	printf("usage: %s [-o output] [input]\n", progname);
	printf("       %s -h\n", progname);
	printf("\n");
	printf("\t%-16s %s\n", "-h",        "display this help text and exit");
	printf("\t%-16s %s\n", "-o output", "write output to 'output' (default=stdout)");
	printf("\t%-16s %s\n", "input",     "read input from 'input' (default=stdin)");
}

int main(int argc, char **argv)
{
	const char *outname = NULL;
	int error = 0;

	extern int   optind;
	extern char *optarg;

	progname = argv[0];
	for (int opt; (opt = getopt(argc, argv, "+ho:")) != -1;) {
		switch (opt) {
		case 'h':
			usage(argv[0]);
			return 0;
		case 'o':
			outname = optarg;
			break;
		default:
			error = 1;
		}
	}

	if (optind < argc - 1) {
		ERROR("Too many input files");
		return 1;
	}
	if (error) return 1;

	FILE *in  = stdin;
	FILE *out = stdout;

	if (optind < argc && !(in = fopen(argv[optind], "r"))) {
		PERROR("Error opening input file");
		return 1;
	}
	if (outname && !(out = fopen(outname, "w"))) {
		PERROR("Error opening output file");
		fclose(in);
		return 1;
	}

	disassemble(in, out);

	fclose(in);
	fclose(out);
	return 0;
}