#include "irq.h"
#include "hollywood.h"
#include "gecko.h"
#include "utils.h"
#include "ipc.h"
#include "memory.h"

const char *exceptions[] = {
	"RESET", "UNDEFINED", "SWI", "INSTR ABORT", "DATA ABORT", "RESERVED", "IRQ", "FIQ"
};

const char *aborts[] = {
	"UNDEFINED",
	"Alignment",
	"UNDEFINED",
	"Alignment",
	"UNDEFINED",
	"Translation",
	"UNDEFINED",
	"Translation",
	"External abort",
	"Domain",
	"External abort",
	"Domain",
	"External abort on translation (first level)",
	"Permission",
	"External abort on translation (second level)",
	"Permission"
};

u8 domvalid[] = {0,0,0,0,0,0,0,1,0,1,0,1,0,1,1,1};

void exc_setup_stack(void);

void exception_initialize(void)
{
	exc_setup_stack();
	u32 cr = get_cr();
	cr |= 0x2; // Data alignment fault checking enable
	set_cr(cr);
}

void exc_handler(u32 type, u32 spsr, u32 *regs)
{
	gecko_printf("\nException %d (%s):\n", type, exceptions[type]);

	u32 pc;

	switch(type) {
		case 3:
		case 7:
			pc = regs[15] - 4;
			break;
		case 4:
			pc = regs[15] - 8;
			break;
		default:
			pc = regs[15];
			break;
	}

	gecko_printf("Registers (%p):\n", regs);
	gecko_printf("  R0-R3: %08x %08x %08x %08x\n", regs[0], regs[1], regs[2], regs[3]);
	gecko_printf("  R4-R7: %08x %08x %08x %08x\n", regs[4], regs[5], regs[6], regs[7]);
	gecko_printf(" R8-R11: %08x %08x %08x %08x\n", regs[8], regs[9], regs[10], regs[11]);
	gecko_printf("R12-R15: %08x %08x %08x %08x\n", regs[12], regs[13], regs[14], pc);

	gecko_printf("SPSR: %08x\n", spsr);
	gecko_printf("CR:   %08x\n", get_cr());
	gecko_printf("TTBR: %08x\n", get_ttbr());
	gecko_printf("DACR: %08x\n", get_dacr());

	if(type == 3 || type == 4) {
		u32 fsr;
		if(type == 3)
			fsr = get_ifsr();
		else
			fsr = get_dfsr();
		gecko_printf("Abort type: %s\n", aborts[fsr&0xf]);
		if(domvalid[fsr&0xf])
			gecko_printf("Domain: %d\n", (fsr>>4)&0xf);
		if(type == 4)
			gecko_printf("Address: 0x%08x\n", get_far());
	}

	panic(0xA3);
}