/*=============================================================================
Copyright (C) 2016 Kristina Brooks
All rights reserved.

This program is free software; you can redistribute it and/or
modify it under the terms of the GNU General Public License
as published by the Free Software Foundation; either version 2
of the License, or (at your option) any later version.

This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
GNU General Public License for more details.

FILE DESCRIPTION
VideoCoreIV second level exception handlers.

=============================================================================*/

#include <common.h>
#include <pcb.h>
#include <exception.h>
#include <hardware.h>
#include <cpu.h>

static const char* g_ExceptionNames[] = { VC4_EXC_NAMES };

static const char* exception_name(uint32_t n) {
	if (n >= (sizeof(g_ExceptionNames)/4))
		return "unknown";
	return g_ExceptionNames[n];
}

#define REGISTER_FORMAT_STRING(prefix) \
	prefix "  r0: 0x%08x  r1: 0x%08x  r2: 0x%08x  r3: 0x%08x\n" \
	prefix "  r4: 0x%08x  r5: 0x%08x  r6: 0x%08x  r7: 0x%08x\n" \
	prefix "  r8: 0x%08x  r9: 0x%08x r10: 0x%08x r11: 0x%08x\n" \
	prefix " r12: 0x%08x r13: 0x%08x r14: 0x%08x r15: 0x%08x\n" \
	prefix "  pc: 0x%08x  lr: 0x%08x  sr: 0x%08x\n"

void sleh_fatal(vc4_saved_state_t* pcb, uint32_t n) {
	printf("Fatal VPU Exception: %s\n", exception_name(n));

	printf("VPU registers:\n");

	printf(
		REGISTER_FORMAT_STRING("   "),
		pcb->r0,
		pcb->r1,
		pcb->r2,
		pcb->r3,
		pcb->r4,
		pcb->r5,
		pcb->r6,
		pcb->r7,
		pcb->r8,
		pcb->r9, 
		pcb->r10,
		pcb->r11,
		pcb->r12,
		pcb->r13,
		pcb->r14,
		pcb->r15,
		pcb->pc,
		pcb->lr,
		pcb->sr
	);

	printf("Exception info:\n");

	printf(
		"   src0: 0x%08x src1: 0x%08x vaddr: 0x%08x\n"
		"      C: 0x%08x    S: 0x%08x\n",
		IC0_SRC0,
		IC0_SRC1,
		IC0_VADDR,
		IC0_C,
		IC0_S
	);

	printf("We are hanging here ...\n");
	
	hang_cpu();
}

void sleh_irq(vc4_saved_state_t* pcb) {
	panic("interrupt at 0x%X!", pcb->pc);
}