faultscreen.c

#include "faultscreen.h"

#include <stdio.h>
#include "Fonts/fonts.h"
#include "faultsplash.h"
#include "display.h"
#include "gfx.h"

#include "max32665.h"
#include "nvic_table.h"
#include "core_cmFunc.h"
#include "core1.h"

struct regs_t {
    unsigned int pc;
    unsigned int sp;
    unsigned int lr;
} static regs;

#define LOAD_REGS() \
    __asm__ __volatile__( \
          "ldr %0, [sp, #24] \n" \
          "ldr %1, [sp, #20] \n" \
          "mov %2, sp \n" \
          : "=r" (regs.pc), \
            "=r" (regs.lr), \
            "=r" (regs.sp) \
    )

static void generic_handler(const char *reason) {
    char lines[3][64];

    Core1_Stop();
    __disable_irq();

    snprintf(lines[0], sizeof(lines[0]), "pc: 0x%08x", regs.pc);
    snprintf(lines[1], sizeof(lines[1]), "sp: 0x%08x", regs.sp);
    snprintf(lines[2], sizeof(lines[2]), "lr: 0x%08x", regs.lr);

	gfx_copy_region(&display_screen, 0, 0, 160, 80, GFX_RLE_MONO,
				faultsplash_rle_len, faultsplash_rle);

	Color black = gfx_color(&display_screen, BLACK);
	Color white = gfx_color(&display_screen, WHITE);

	gfx_puts(&Font12, &display_screen, 52, 32, reason, white, black);
	gfx_puts(&Font12, &display_screen, 52, 44, lines[0], white, black);
	gfx_puts(&Font12, &display_screen, 52, 56, lines[1], white, black);
	gfx_puts(&Font12, &display_screen, 52, 68, lines[2], white, black);
	gfx_update(&display_screen);
}

static void NMI_Handler_(void) {
    LOAD_REGS();
    generic_handler("NMI Fault");
}

static void HardFault_Handler_(void) {
    LOAD_REGS();
    generic_handler("HardFault");
}

static void MemManage_Handler_(void) {
    LOAD_REGS();
    generic_handler("MemMgmtFault");
}

static void BusFault_Handler_(void) {
    LOAD_REGS();
    generic_handler("BusFault");
}

static void UsageFault_Handler_(void) {
    LOAD_REGS();
    generic_handler("UsageFault");
}

void card10_set_fault_handlers(void) {
    NVIC_SetVector(NonMaskableInt_IRQn, NMI_Handler_);
    NVIC_SetVector(HardFault_IRQn, HardFault_Handler_);
    NVIC_SetVector(MemoryManagement_IRQn, MemManage_Handler_);
    NVIC_SetVector(BusFault_IRQn, BusFault_Handler_);
    NVIC_SetVector(UsageFault_IRQn, UsageFault_Handler_);
}