forked from Mirrors/opensbi
848ed4f644
An ecall handler should only return error if valid SBI function fails. Otherwise, it should succeed with appropriate error in a0. Get rid of unnecessary setting of the temporary return variable to zero for the cases where errors are not expected. Signed-off-by: Atish Patra <atish.patra@wdc.com> Reviewed-by: Anup Patel <anup.patel@wdc.com>
126 lines
3.0 KiB
C
126 lines
3.0 KiB
C
/*
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*
|
|
* Copyright (c) 2019 Western Digital Corporation or its affiliates.
|
|
*
|
|
* Authors:
|
|
* Anup Patel <anup.patel@wdc.com>
|
|
*/
|
|
|
|
#include <sbi/sbi_console.h>
|
|
#include <sbi/sbi_ecall.h>
|
|
#include <sbi/sbi_ecall_interface.h>
|
|
#include <sbi/sbi_error.h>
|
|
#include <sbi/sbi_ipi.h>
|
|
#include <sbi/sbi_system.h>
|
|
#include <sbi/sbi_timer.h>
|
|
#include <sbi/sbi_tlb.h>
|
|
#include <sbi/sbi_trap.h>
|
|
#include <sbi/sbi_hart.h>
|
|
|
|
#define SBI_ECALL_VERSION_MAJOR 0
|
|
#define SBI_ECALL_VERSION_MINOR 1
|
|
|
|
u16 sbi_ecall_version_major(void)
|
|
{
|
|
return SBI_ECALL_VERSION_MAJOR;
|
|
}
|
|
|
|
u16 sbi_ecall_version_minor(void)
|
|
{
|
|
return SBI_ECALL_VERSION_MINOR;
|
|
}
|
|
|
|
int sbi_ecall_0_1_handler(u32 hartid, struct sbi_trap_regs *regs,
|
|
struct sbi_scratch *scratch,
|
|
struct unpriv_trap *uptrap)
|
|
{
|
|
int ret = 0;
|
|
struct sbi_tlb_info tlb_info;
|
|
u32 source_hart = sbi_current_hartid();
|
|
|
|
switch (regs->a7) {
|
|
case SBI_EXT_0_1_SET_TIMER:
|
|
#if __riscv_xlen == 32
|
|
sbi_timer_event_start(scratch,
|
|
(((u64)regs->a1 << 32) | (u64)regs->a0));
|
|
#else
|
|
sbi_timer_event_start(scratch, (u64)regs->a0);
|
|
#endif
|
|
break;
|
|
case SBI_EXT_0_1_CONSOLE_PUTCHAR:
|
|
sbi_putc(regs->a0);
|
|
break;
|
|
case SBI_EXT_0_1_CONSOLE_GETCHAR:
|
|
regs->a0 = sbi_getc();
|
|
break;
|
|
case SBI_EXT_0_1_CLEAR_IPI:
|
|
sbi_ipi_clear_smode(scratch);
|
|
break;
|
|
case SBI_EXT_0_1_SEND_IPI:
|
|
ret = sbi_ipi_send_many(scratch, uptrap, (ulong *)regs->a0,
|
|
SBI_IPI_EVENT_SOFT, NULL);
|
|
break;
|
|
case SBI_EXT_0_1_REMOTE_FENCE_I:
|
|
tlb_info.start = 0;
|
|
tlb_info.size = 0;
|
|
tlb_info.type = SBI_ITLB_FLUSH;
|
|
tlb_info.shart_mask = 1UL << source_hart;
|
|
ret = sbi_ipi_send_many(scratch, uptrap, (ulong *)regs->a0,
|
|
SBI_IPI_EVENT_FENCE_I, &tlb_info);
|
|
break;
|
|
case SBI_EXT_0_1_REMOTE_SFENCE_VMA:
|
|
tlb_info.start = (unsigned long)regs->a1;
|
|
tlb_info.size = (unsigned long)regs->a2;
|
|
tlb_info.type = SBI_TLB_FLUSH_VMA;
|
|
tlb_info.shart_mask = 1UL << source_hart;
|
|
|
|
ret = sbi_ipi_send_many(scratch, uptrap, (ulong *)regs->a0,
|
|
SBI_IPI_EVENT_SFENCE_VMA, &tlb_info);
|
|
break;
|
|
case SBI_EXT_0_1_REMOTE_SFENCE_VMA_ASID:
|
|
tlb_info.start = (unsigned long)regs->a1;
|
|
tlb_info.size = (unsigned long)regs->a2;
|
|
tlb_info.asid = (unsigned long)regs->a3;
|
|
tlb_info.type = SBI_TLB_FLUSH_VMA_ASID;
|
|
tlb_info.shart_mask = 1UL << source_hart;
|
|
|
|
ret = sbi_ipi_send_many(scratch, uptrap, (ulong *)regs->a0,
|
|
SBI_IPI_EVENT_SFENCE_VMA_ASID,
|
|
&tlb_info);
|
|
break;
|
|
case SBI_EXT_0_1_SHUTDOWN:
|
|
sbi_system_shutdown(scratch, 0);
|
|
break;
|
|
default:
|
|
regs->a0 = SBI_ENOTSUPP;
|
|
};
|
|
|
|
return ret;
|
|
}
|
|
|
|
int sbi_ecall_handler(u32 hartid, ulong mcause, struct sbi_trap_regs *regs,
|
|
struct sbi_scratch *scratch)
|
|
{
|
|
int ret = 0;
|
|
struct unpriv_trap uptrap;
|
|
u32 extension_id = regs->a7;
|
|
|
|
if (extension_id >= SBI_EXT_0_1_SET_TIMER &&
|
|
extension_id <= SBI_EXT_0_1_SHUTDOWN) {
|
|
ret = sbi_ecall_0_1_handler(hartid, regs, scratch, &uptrap);
|
|
} else {
|
|
regs->a0 = SBI_ENOTSUPP;
|
|
}
|
|
|
|
if (!ret) {
|
|
regs->mepc += 4;
|
|
} else if (ret == SBI_ETRAP) {
|
|
ret = 0;
|
|
sbi_trap_redirect(regs, scratch, regs->mepc,
|
|
uptrap.cause, uptrap.tval);
|
|
}
|
|
|
|
return ret;
|
|
}
|