104 lines
3.7 KiB
C
104 lines
3.7 KiB
C
/*
|
|
* This file is part of the libpayload project.
|
|
*
|
|
* Copyright (C) 2014 Imagination Technologies
|
|
*
|
|
* 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; version 2 of the License.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include <arch/exception.h>
|
|
#include <exception.h>
|
|
#include <libpayload.h>
|
|
#include <stdint.h>
|
|
|
|
u32 exception_stack[0x400] __attribute__((aligned(8)));
|
|
struct exception_state_t exception_state;
|
|
|
|
static const char *names[EXC_COUNT] = {
|
|
[EXC_CACHE_ERROR] = "Cache error exception",
|
|
[EXC_TLB_REFILL_AND_ALL] = "TLB refill or general exception",
|
|
[EXC_INTERRUPT] = "Interrupt",
|
|
[EXC_EJTAG_DEBUG] = "EJTAG debug exception"
|
|
};
|
|
|
|
static void dump_exception_state(void)
|
|
{
|
|
printf("%s exception!\n", names[exception_state_ptr->vector]);
|
|
printf("\nRegisters:\n");
|
|
printf("ZERO:\t0x%08x\n", exception_state_ptr->regs.zero);
|
|
printf("AT:\t0x%08x\n", exception_state_ptr->regs.at);
|
|
printf("V0:\t0x%08x\n", exception_state_ptr->regs.v0);
|
|
printf("V1:\t0x%08x\n", exception_state_ptr->regs.v1);
|
|
printf("A0:\t0x%08x\n", exception_state_ptr->regs.a0);
|
|
printf("A1:\t0x%08x\n", exception_state_ptr->regs.a1);
|
|
printf("A2:\t0x%08x\n", exception_state_ptr->regs.a2);
|
|
printf("A3:\t0x%08x\n", exception_state_ptr->regs.a3);
|
|
printf("T0:\t0x%08x\n", exception_state_ptr->regs.t0);
|
|
printf("T1:\t0x%08x\n", exception_state_ptr->regs.t1);
|
|
printf("T2:\t0x%08x\n", exception_state_ptr->regs.t2);
|
|
printf("T3:\t0x%08x\n", exception_state_ptr->regs.t3);
|
|
printf("T4:\t0x%08x\n", exception_state_ptr->regs.t4);
|
|
printf("T5:\t0x%08x\n", exception_state_ptr->regs.t5);
|
|
printf("T6:\t0x%08x\n", exception_state_ptr->regs.t6);
|
|
printf("T7:\t0x%08x\n", exception_state_ptr->regs.t7);
|
|
printf("S0:\t0x%08x\n", exception_state_ptr->regs.s0);
|
|
printf("S1:\t0x%08x\n", exception_state_ptr->regs.s1);
|
|
printf("S2:\t0x%08x\n", exception_state_ptr->regs.s2);
|
|
printf("S3:\t0x%08x\n", exception_state_ptr->regs.s3);
|
|
printf("S4:\t0x%08x\n", exception_state_ptr->regs.s4);
|
|
printf("S5:\t0x%08x\n", exception_state_ptr->regs.s5);
|
|
printf("S6:\t0x%08x\n", exception_state_ptr->regs.s6);
|
|
printf("S7:\t0x%08x\n", exception_state_ptr->regs.s7);
|
|
printf("T8:\t0x%08x\n", exception_state_ptr->regs.t8);
|
|
printf("T9:\t0x%08x\n", exception_state_ptr->regs.t9);
|
|
printf("K0:\t0x%08x\n", exception_state_ptr->regs.k0);
|
|
printf("K1:\t0x%08x\n", exception_state_ptr->regs.k1);
|
|
printf("GP:\t0x%08x\n", exception_state_ptr->regs.gp);
|
|
printf("SP:\t0x%08x\n", exception_state_ptr->regs.sp);
|
|
printf("FP:\t0x%08x\n", exception_state_ptr->regs.fp);
|
|
printf("RA:\t0x%08x\n", exception_state_ptr->regs.ra);
|
|
}
|
|
|
|
static void dump_stack(uintptr_t addr, size_t bytes)
|
|
{
|
|
int i, j;
|
|
const int words_per_line = 8;
|
|
int words_to_print;
|
|
uint32_t *ptr = (uint32_t *)
|
|
(addr & ~(words_per_line * sizeof(*ptr) - 1));
|
|
|
|
printf("Dumping stack:\n");
|
|
words_to_print = bytes/sizeof(*ptr);
|
|
for (i = words_to_print; i >= 0; i -= words_per_line) {
|
|
printf("%p: ", ptr + i);
|
|
for (j = i; j < i + words_per_line; j++)
|
|
printf("%08x ", *(ptr + j));
|
|
printf("\n");
|
|
}
|
|
}
|
|
|
|
|
|
void exception_dispatch(void)
|
|
{
|
|
u32 vec = exception_state_ptr->vector;
|
|
die_if(vec >= EXC_COUNT || !names[vec], "Bad exception vector %u", vec);
|
|
|
|
dump_exception_state();
|
|
dump_stack(exception_state_ptr->regs.sp, 512);
|
|
halt();
|
|
}
|
|
|
|
void exception_init(void)
|
|
{
|
|
exception_stack_end = exception_stack + ARRAY_SIZE(exception_stack);
|
|
exception_state_ptr = &exception_state;
|
|
exception_init_asm();
|
|
}
|