trap.c

/*=============================================================================
Copyright (C) 2016-2017 Authors of rpi-open-firmware
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 <lib/runtime.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"

static void print_vpu_state(vc4_saved_state_t* pcb) {
	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 (IC0):\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("Exception info (IC1):\n");

	printf(
	    "   src0: 0x%08x src1: 0x%08x vaddr: 0x%08x\n"
	    "      C: 0x%08x    S: 0x%08x\n",
	    IC1_SRC0,
	    IC1_SRC1,
	    IC1_VADDR,
	    IC1_C,
	    IC1_S
	);
}

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

	print_vpu_state(pcb);

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

	hang_cpu();
}

extern void arm_monitor_interrupt();

void sleh_irq(vc4_saved_state_t* pcb, uint32_t tp) {
	uint32_t status = IC0_S;
	uint32_t source = status & 0xFF;

	printf("VPU Received interrupt from source %d\n", source);

	if (source == INTERRUPT_ARM) {
		arm_monitor_interrupt();
	} else {
		print_vpu_state(pcb);
		panic("unknown interrupt source!");
	}
}