148 lines
3.6 KiB
C
148 lines
3.6 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (c) 2016-17 Microsemi Corporation.
|
|
* Padmarao Begari, Microsemi Corporation <padmarao.begari@microsemi.com>
|
|
*
|
|
* Copyright (C) 2017 Andes Technology Corporation
|
|
* Rick Chen, Andes Technology Corporation <rick@andestech.com>
|
|
*
|
|
* Copyright (C) 2019 Sean Anderson <seanga2@gmail.com>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <efi_loader.h>
|
|
#include <hang.h>
|
|
#include <irq_func.h>
|
|
#include <asm/ptrace.h>
|
|
#include <asm/system.h>
|
|
#include <asm/encoding.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
static void show_efi_loaded_images(uintptr_t epc)
|
|
{
|
|
efi_print_image_infos((void *)epc);
|
|
}
|
|
|
|
static void show_regs(struct pt_regs *regs)
|
|
{
|
|
#ifdef CONFIG_SHOW_REGS
|
|
printf("SP: " REG_FMT " GP: " REG_FMT " TP: " REG_FMT "\n",
|
|
regs->sp, regs->gp, regs->tp);
|
|
printf("T0: " REG_FMT " T1: " REG_FMT " T2: " REG_FMT "\n",
|
|
regs->t0, regs->t1, regs->t2);
|
|
printf("S0: " REG_FMT " S1: " REG_FMT " A0: " REG_FMT "\n",
|
|
regs->s0, regs->s1, regs->a0);
|
|
printf("A1: " REG_FMT " A2: " REG_FMT " A3: " REG_FMT "\n",
|
|
regs->a1, regs->a2, regs->a3);
|
|
printf("A4: " REG_FMT " A5: " REG_FMT " A6: " REG_FMT "\n",
|
|
regs->a4, regs->a5, regs->a6);
|
|
printf("A7: " REG_FMT " S2: " REG_FMT " S3: " REG_FMT "\n",
|
|
regs->a7, regs->s2, regs->s3);
|
|
printf("S4: " REG_FMT " S5: " REG_FMT " S6: " REG_FMT "\n",
|
|
regs->s4, regs->s5, regs->s6);
|
|
printf("S7: " REG_FMT " S8: " REG_FMT " S9: " REG_FMT "\n",
|
|
regs->s7, regs->s8, regs->s9);
|
|
printf("S10: " REG_FMT " S11: " REG_FMT " T3: " REG_FMT "\n",
|
|
regs->s10, regs->s11, regs->t3);
|
|
printf("T4: " REG_FMT " T5: " REG_FMT " T6: " REG_FMT "\n\n",
|
|
regs->t4, regs->t5, regs->t6);
|
|
#endif
|
|
}
|
|
|
|
static void _exit_trap(ulong code, ulong epc, ulong tval, struct pt_regs *regs)
|
|
{
|
|
static const char * const exception_code[] = {
|
|
"Instruction address misaligned",
|
|
"Instruction access fault",
|
|
"Illegal instruction",
|
|
"Breakpoint",
|
|
"Load address misaligned",
|
|
"Load access fault",
|
|
"Store/AMO address misaligned",
|
|
"Store/AMO access fault",
|
|
"Environment call from U-mode",
|
|
"Environment call from S-mode",
|
|
"Reserved",
|
|
"Environment call from M-mode",
|
|
"Instruction page fault",
|
|
"Load page fault",
|
|
"Reserved",
|
|
"Store/AMO page fault",
|
|
};
|
|
|
|
if (code < ARRAY_SIZE(exception_code))
|
|
printf("Unhandled exception: %s\n", exception_code[code]);
|
|
else
|
|
printf("Unhandled exception code: %ld\n", code);
|
|
|
|
printf("EPC: " REG_FMT " RA: " REG_FMT " TVAL: " REG_FMT "\n",
|
|
epc, regs->ra, tval);
|
|
if (gd->flags & GD_FLG_RELOC)
|
|
printf("EPC: " REG_FMT " RA: " REG_FMT " reloc adjusted\n\n",
|
|
epc - gd->reloc_off, regs->ra - gd->reloc_off);
|
|
|
|
show_regs(regs);
|
|
show_efi_loaded_images(epc);
|
|
hang();
|
|
}
|
|
|
|
int interrupt_init(void)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* enable interrupts
|
|
*/
|
|
void enable_interrupts(void)
|
|
{
|
|
}
|
|
|
|
/*
|
|
* disable interrupts
|
|
*/
|
|
int disable_interrupts(void)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
ulong handle_trap(ulong cause, ulong epc, ulong tval, struct pt_regs *regs)
|
|
{
|
|
ulong is_irq, irq;
|
|
|
|
is_irq = (cause & MCAUSE_INT);
|
|
irq = (cause & ~MCAUSE_INT);
|
|
|
|
if (is_irq) {
|
|
switch (irq) {
|
|
case IRQ_M_EXT:
|
|
case IRQ_S_EXT:
|
|
external_interrupt(0); /* handle external interrupt */
|
|
break;
|
|
case IRQ_M_TIMER:
|
|
case IRQ_S_TIMER:
|
|
timer_interrupt(0); /* handle timer interrupt */
|
|
break;
|
|
default:
|
|
_exit_trap(cause, epc, tval, regs);
|
|
break;
|
|
};
|
|
} else {
|
|
_exit_trap(cause, epc, tval, regs);
|
|
}
|
|
|
|
return epc;
|
|
}
|
|
|
|
/*
|
|
*Entry Point for PLIC Interrupt Handler
|
|
*/
|
|
__attribute__((weak)) void external_interrupt(struct pt_regs *regs)
|
|
{
|
|
}
|
|
|
|
__attribute__((weak)) void timer_interrupt(struct pt_regs *regs)
|
|
{
|
|
}
|