mirror of
https://github.com/riscv-software-src/opensbi.git
synced 2025-08-24 15:31:22 +01:00
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>
130 lines
3.6 KiB
C
130 lines
3.6 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_ecall.h>
|
|
#include <sbi/sbi_ecall_interface.h>
|
|
#include <sbi/sbi_error.h>
|
|
#include <sbi/sbi_hart.h>
|
|
#include <sbi/sbi_ipi.h>
|
|
#include <sbi/sbi_timer.h>
|
|
#include <sbi/sbi_tlb.h>
|
|
|
|
static int sbi_ecall_time_handler(unsigned long extid, unsigned long funcid,
|
|
unsigned long *args, unsigned long *out_val,
|
|
struct sbi_trap_info *out_trap)
|
|
{
|
|
int ret = 0;
|
|
|
|
if (funcid == SBI_EXT_TIME_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
|
|
} else
|
|
ret = SBI_ENOTSUPP;
|
|
|
|
return ret;
|
|
}
|
|
|
|
struct sbi_ecall_extension ecall_time = {
|
|
.extid_start = SBI_EXT_TIME,
|
|
.extid_end = SBI_EXT_TIME,
|
|
.handle = sbi_ecall_time_handler,
|
|
};
|
|
|
|
static int sbi_ecall_rfence_handler(unsigned long extid, unsigned long funcid,
|
|
unsigned long *args, unsigned long *out_val,
|
|
struct sbi_trap_info *out_trap)
|
|
{
|
|
int ret = 0;
|
|
unsigned long vmid;
|
|
struct sbi_tlb_info tlb_info;
|
|
u32 source_hart = current_hartid();
|
|
|
|
if (funcid >= SBI_EXT_RFENCE_REMOTE_HFENCE_GVMA &&
|
|
funcid <= SBI_EXT_RFENCE_REMOTE_HFENCE_VVMA_ASID)
|
|
if (!misa_extension('H'))
|
|
return SBI_ENOTSUPP;
|
|
|
|
switch (funcid) {
|
|
case SBI_EXT_RFENCE_REMOTE_FENCE_I:
|
|
SBI_TLB_INFO_INIT(&tlb_info, 0, 0, 0, 0,
|
|
SBI_ITLB_FLUSH, source_hart);
|
|
ret = sbi_tlb_request(args[0], args[1], &tlb_info);
|
|
break;
|
|
case SBI_EXT_RFENCE_REMOTE_HFENCE_GVMA:
|
|
SBI_TLB_INFO_INIT(&tlb_info, args[2], args[3], 0, 0,
|
|
SBI_TLB_FLUSH_GVMA, source_hart);
|
|
ret = sbi_tlb_request(args[0], args[1], &tlb_info);
|
|
break;
|
|
case SBI_EXT_RFENCE_REMOTE_HFENCE_GVMA_VMID:
|
|
SBI_TLB_INFO_INIT(&tlb_info, args[2], args[3], 0, args[4],
|
|
SBI_TLB_FLUSH_GVMA_VMID, source_hart);
|
|
ret = sbi_tlb_request(args[0], args[1], &tlb_info);
|
|
break;
|
|
case SBI_EXT_RFENCE_REMOTE_HFENCE_VVMA:
|
|
vmid = (csr_read(CSR_HGATP) & HGATP_VMID_MASK);
|
|
vmid = vmid >> HGATP_VMID_SHIFT;
|
|
SBI_TLB_INFO_INIT(&tlb_info, args[2], args[3], 0, vmid,
|
|
SBI_TLB_FLUSH_VVMA, source_hart);
|
|
ret = sbi_tlb_request(args[0], args[1], &tlb_info);
|
|
break;
|
|
case SBI_EXT_RFENCE_REMOTE_HFENCE_VVMA_ASID:
|
|
vmid = (csr_read(CSR_HGATP) & HGATP_VMID_MASK);
|
|
vmid = vmid >> HGATP_VMID_SHIFT;
|
|
SBI_TLB_INFO_INIT(&tlb_info, args[2], args[3], args[4], vmid,
|
|
SBI_TLB_FLUSH_VVMA_ASID, source_hart);
|
|
ret = sbi_tlb_request(args[0], args[1], &tlb_info);
|
|
break;
|
|
case SBI_EXT_RFENCE_REMOTE_SFENCE_VMA:
|
|
SBI_TLB_INFO_INIT(&tlb_info, args[2], args[3], 0, 0,
|
|
SBI_TLB_FLUSH_VMA, source_hart);
|
|
ret = sbi_tlb_request(args[0], args[1], &tlb_info);
|
|
break;
|
|
case SBI_EXT_RFENCE_REMOTE_SFENCE_VMA_ASID:
|
|
SBI_TLB_INFO_INIT(&tlb_info, args[2], args[3], args[4], 0,
|
|
SBI_TLB_FLUSH_VMA_ASID, source_hart);
|
|
ret = sbi_tlb_request(args[0], args[1], &tlb_info);
|
|
break;
|
|
default:
|
|
ret = SBI_ENOTSUPP;
|
|
};
|
|
|
|
return ret;
|
|
}
|
|
|
|
struct sbi_ecall_extension ecall_rfence = {
|
|
.extid_start = SBI_EXT_RFENCE,
|
|
.extid_end = SBI_EXT_RFENCE,
|
|
.handle = sbi_ecall_rfence_handler,
|
|
};
|
|
|
|
static int sbi_ecall_ipi_handler(unsigned long extid, unsigned long funcid,
|
|
unsigned long *args, unsigned long *out_val,
|
|
struct sbi_trap_info *out_trap)
|
|
{
|
|
int ret = 0;
|
|
|
|
if (funcid == SBI_EXT_IPI_SEND_IPI)
|
|
ret = sbi_ipi_send_smode(args[0], args[1]);
|
|
else
|
|
ret = SBI_ENOTSUPP;
|
|
|
|
return ret;
|
|
}
|
|
|
|
struct sbi_ecall_extension ecall_ipi = {
|
|
.extid_start = SBI_EXT_IPI,
|
|
.extid_end = SBI_EXT_IPI,
|
|
.handle = sbi_ecall_ipi_handler,
|
|
};
|