101 lines
3.1 KiB
C
101 lines
3.1 KiB
C
#include "stddef.h"
|
|
#include "head.h"
|
|
#include "rtthread.h"
|
|
#include "rt_hw_stack_frame.h"
|
|
|
|
static const char *g_fault_cause[]={
|
|
"Instruction address misaligned",// 0
|
|
"Instruction access fault",// 1
|
|
"Illegal instruction",// 2
|
|
"Breakpoint",// 3
|
|
"Load address misaligned",// 4
|
|
"Load access fault",// 5
|
|
"Store address misaligned",// 6
|
|
"Store access fault",// 7
|
|
"Environment call from U-mode",// 8
|
|
"Environment call from S-mode",// 9
|
|
"",
|
|
"Environment call from M-mode",// 11
|
|
"Instruction page fault",// 12
|
|
"Load page fault",// 13
|
|
"",
|
|
"Store page fault",// 15
|
|
};
|
|
|
|
|
|
static void trap_print(uint32_t irq_num, rt_hw_stack_frame_t *stack) {
|
|
my_printf("fault reason is %s\n", g_fault_cause[irq_num]);
|
|
my_printf("x1(ra): %08x\n", stack->ra);
|
|
my_printf("x3(gp): %08x\n", stack->gp);
|
|
my_printf("x4(tp): %08x\n", stack->tp);
|
|
my_printf("x5(t0): %08x\n", stack->t0);
|
|
my_printf("x6(t1): %08x\n", stack->t1);
|
|
my_printf("x7(t2): %08x\n", stack->t2);
|
|
my_printf("x8(s0|fp): %08x\n", stack->s0_fp);
|
|
my_printf("x9(s1): %08x\n", stack->s1);
|
|
my_printf("x10(a0): %08x\n", stack->a0);
|
|
my_printf("x11(a1): %08x\n", stack->a1);
|
|
my_printf("x12(a2): %08x\n", stack->a2);
|
|
my_printf("x13(a3): %08x\n", stack->a3);
|
|
my_printf("x14(a4): %08x\n", stack->a4);
|
|
my_printf("x15(a5): %08x\n", stack->a5);
|
|
my_printf("x16(a6): %08x\n", stack->a6);
|
|
my_printf("x17(a7): %08x\n", stack->a7);
|
|
my_printf("x18(s2): %08x\n", stack->s2);
|
|
my_printf("x19(s3): %08x\n", stack->s3);
|
|
my_printf("x20(s4): %08x\n", stack->s4);
|
|
my_printf("x21(s5): %08x\n", stack->s5);
|
|
my_printf("x22(s6): %08x\n", stack->s6);
|
|
my_printf("x23(s7): %08x\n", stack->s7);
|
|
my_printf("x24(s8): %08x\n", stack->s8);
|
|
my_printf("x25(s9): %08x\n", stack->s9);
|
|
my_printf("x26(s10): %08x\n", stack->s10);
|
|
my_printf("x27(s11): %08x\n", stack->s11);
|
|
my_printf("x28(t3): %08x\n", stack->t3);
|
|
my_printf("x29(t4): %08x\n", stack->t4);
|
|
my_printf("x30(t5): %08x\n", stack->t5);
|
|
my_printf("x31(t6): %08x\n", stack->t6);
|
|
my_printf("mstatus: %08x\n", stack->mstatus);
|
|
my_printf("mepc: %08x\n", stack->epc);
|
|
// my_printf("mtval: %08x\n", read_csr(mtval));
|
|
|
|
// 函数调用错误，直接跳过这个函数
|
|
if(irq_num==1){
|
|
my_printf("skip the function call, return to %08x\n", stack->ra);
|
|
stack->epc = stack->ra;
|
|
}
|
|
|
|
// write_csr(mscratch, 0xffffffff);
|
|
}
|
|
|
|
|
|
|
|
void handle_trap(size_t mcause, size_t mepc, size_t sp) {
|
|
if (mcause & 0x80000000) {
|
|
my_printf("interupt mcause=%08x, mepc=%08x, sp=%08x\n", mcause, mepc, sp);
|
|
} else {
|
|
trap_print(mcause, (rt_hw_stack_frame_t*)sp);
|
|
while (1);
|
|
}
|
|
}
|
|
|
|
|
|
static void tick_handler(int vec, void* par) {
|
|
(void)vec;
|
|
(void)par;
|
|
rt_tick_increase();
|
|
// my_printf("tick irq %d\n", vec);
|
|
}
|
|
|
|
|
|
static uint32_t g_mem_heap[200 * 1024 / 4];
|
|
void rt_hw_board_init(void) {
|
|
set_csr(mie, (1 << 3) | (1 << 7));
|
|
set_csr(mip, (1 << 3));
|
|
rt_system_heap_init(g_mem_heap, g_mem_heap + sizeof(g_mem_heap) / 4);
|
|
rt_hw_interrupt_init();
|
|
rt_hw_interrupt_install(7, tick_handler, 0, "tick_handler");
|
|
}
|
|
|
|
|