Loading...
// 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 <hang.h>
#include <irq_func.h>
#include <asm/ptrace.h>
#include <asm/system.h>
#include <asm/encoding.h>

static void show_regs(struct pt_regs *regs)
{
#ifdef CONFIG_SHOW_REGS
	printf("RA: " REG_FMT " SP:  " REG_FMT " GP:  " REG_FMT "\n",
	       regs->ra, regs->sp, regs->gp);
	printf("TP: " REG_FMT " T0:  " REG_FMT " T1:  " REG_FMT "\n",
	       regs->tp, regs->t0, regs->t1);
	printf("T2: " REG_FMT " S0:  " REG_FMT " S1:  " REG_FMT "\n",
	       regs->t2, regs->s0, regs->s1);
	printf("A0: " REG_FMT " A1:  " REG_FMT " A2:  " REG_FMT "\n",
	       regs->a0, regs->a1, regs->a2);
	printf("A3: " REG_FMT " A4:  " REG_FMT " A5:  " REG_FMT "\n",
	       regs->a3, regs->a4, regs->a5);
	printf("A6: " REG_FMT " A7:  " REG_FMT " S2:  " REG_FMT "\n",
	       regs->a6, regs->a7, regs->s2);
	printf("S3: " REG_FMT " S4:  " REG_FMT " S5:  " REG_FMT "\n",
	       regs->s3, regs->s4, regs->s5);
	printf("S6: " REG_FMT " S7:  " REG_FMT " S8:  " REG_FMT "\n",
	       regs->s6, regs->s7, regs->s8);
	printf("S9: " REG_FMT " S10: " REG_FMT " S11: " REG_FMT "\n",
	       regs->s9, regs->s10, regs->s11);
	printf("T3: " REG_FMT " T4:  " REG_FMT " T5:  " REG_FMT "\n",
	       regs->t3, regs->t4, regs->t5);
	printf("T6: " REG_FMT "\n", 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 " TVAL: " REG_FMT "\n", epc, tval);
	show_regs(regs);
	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)
{
}