forked from Mirrors/opensbi
5338679ff0
The HFENCE VVMA instructions flushes TLB based on the VMID present in HGATP CSR. To handle this, we get the current VMID for SBI HFENCE VVMA call and we use this current VMID to do remote TLB HFENCE VVMA on desired set of HARTs. Signed-off-by: Anup Patel <anup.patel@wdc.com> Reviewed-by: Atish Patra <atish.patra@wdc.com>
118 lines
2.9 KiB
C
118 lines
2.9 KiB
C
/*
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*
|
|
* Copyright (c) 2020 Western Digital Corporation or its affiliates.
|
|
*
|
|
* Authors:
|
|
* Anup Patel <anup.patel@wdc.com>
|
|
* Atish Patra <atish.patra@wdc.com>
|
|
*/
|
|
|
|
#include <sbi/riscv_asm.h>
|
|
#include <sbi/sbi_console.h>
|
|
#include <sbi/sbi_ecall.h>
|
|
#include <sbi/sbi_ecall_interface.h>
|
|
#include <sbi/sbi_error.h>
|
|
#include <sbi/sbi_hsm.h>
|
|
#include <sbi/sbi_ipi.h>
|
|
#include <sbi/sbi_platform.h>
|
|
#include <sbi/sbi_system.h>
|
|
#include <sbi/sbi_timer.h>
|
|
#include <sbi/sbi_tlb.h>
|
|
#include <sbi/sbi_trap.h>
|
|
#include <sbi/sbi_unpriv.h>
|
|
#include <sbi/sbi_hart.h>
|
|
|
|
static int sbi_load_hart_mask_unpriv(ulong *pmask, ulong *hmask,
|
|
struct sbi_trap_info *uptrap)
|
|
{
|
|
ulong mask = 0;
|
|
|
|
if (pmask) {
|
|
mask = sbi_load_ulong(pmask, uptrap);
|
|
if (uptrap->cause)
|
|
return SBI_ETRAP;
|
|
} else {
|
|
sbi_hsm_hart_started_mask(0, &mask);
|
|
}
|
|
*hmask = mask;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sbi_ecall_legacy_handler(unsigned long extid, unsigned long funcid,
|
|
unsigned long *args, unsigned long *out_val,
|
|
struct sbi_trap_info *out_trap)
|
|
{
|
|
int ret = 0;
|
|
struct sbi_tlb_info tlb_info;
|
|
u32 source_hart = current_hartid();
|
|
ulong hmask = 0;
|
|
|
|
switch (extid) {
|
|
case SBI_EXT_0_1_SET_TIMER:
|
|
#if __riscv_xlen == 32
|
|
sbi_timer_event_start((((u64)args[1] << 32) | (u64)args[0]));
|
|
#else
|
|
sbi_timer_event_start((u64)args[0]);
|
|
#endif
|
|
break;
|
|
case SBI_EXT_0_1_CONSOLE_PUTCHAR:
|
|
sbi_putc(args[0]);
|
|
break;
|
|
case SBI_EXT_0_1_CONSOLE_GETCHAR:
|
|
ret = sbi_getc();
|
|
break;
|
|
case SBI_EXT_0_1_CLEAR_IPI:
|
|
sbi_ipi_clear_smode();
|
|
break;
|
|
case SBI_EXT_0_1_SEND_IPI:
|
|
ret = sbi_load_hart_mask_unpriv((ulong *)args[0],
|
|
&hmask, out_trap);
|
|
if (ret != SBI_ETRAP)
|
|
ret = sbi_ipi_send_smode(hmask, 0);
|
|
break;
|
|
case SBI_EXT_0_1_REMOTE_FENCE_I:
|
|
ret = sbi_load_hart_mask_unpriv((ulong *)args[0],
|
|
&hmask, out_trap);
|
|
if (ret != SBI_ETRAP) {
|
|
SBI_TLB_INFO_INIT(&tlb_info, 0, 0, 0, 0,
|
|
SBI_ITLB_FLUSH, source_hart);
|
|
ret = sbi_tlb_request(hmask, 0, &tlb_info);
|
|
}
|
|
break;
|
|
case SBI_EXT_0_1_REMOTE_SFENCE_VMA:
|
|
ret = sbi_load_hart_mask_unpriv((ulong *)args[0],
|
|
&hmask, out_trap);
|
|
if (ret != SBI_ETRAP) {
|
|
SBI_TLB_INFO_INIT(&tlb_info, args[1], args[2], 0, 0,
|
|
SBI_TLB_FLUSH_VMA, source_hart);
|
|
ret = sbi_tlb_request(hmask, 0, &tlb_info);
|
|
}
|
|
break;
|
|
case SBI_EXT_0_1_REMOTE_SFENCE_VMA_ASID:
|
|
ret = sbi_load_hart_mask_unpriv((ulong *)args[0],
|
|
&hmask, out_trap);
|
|
if (ret != SBI_ETRAP) {
|
|
SBI_TLB_INFO_INIT(&tlb_info, args[1], args[2], args[3],
|
|
0, SBI_TLB_FLUSH_VMA_ASID,
|
|
source_hart);
|
|
ret = sbi_tlb_request(hmask, 0, &tlb_info);
|
|
}
|
|
break;
|
|
case SBI_EXT_0_1_SHUTDOWN:
|
|
sbi_system_reset(SBI_PLATFORM_RESET_SHUTDOWN);
|
|
break;
|
|
default:
|
|
ret = SBI_ENOTSUPP;
|
|
};
|
|
|
|
return ret;
|
|
}
|
|
|
|
struct sbi_ecall_extension ecall_legacy = {
|
|
.extid_start = SBI_EXT_0_1_SET_TIMER,
|
|
.extid_end = SBI_EXT_0_1_SHUTDOWN,
|
|
.handle = sbi_ecall_legacy_handler,
|
|
};
|