forked from Mirrors/opensbi
e307ba7d46
The vendor extension ID range is large, but at runtime at most a single ID will be available. Narrow the range in the register_extensions callback. After narrowing, we no longer need to check that the extension ID is correct in the other callbacks, as those callbacks will never be invoked with anything other than the single ID. Signed-off-by: Andrew Jones <ajones@ventanamicro.com> Reviewed-by: Anup Patel <anup@brainfault.org>
67 lines
1.7 KiB
C
67 lines
1.7 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/sbi_ecall.h>
|
|
#include <sbi/sbi_ecall_interface.h>
|
|
#include <sbi/sbi_error.h>
|
|
#include <sbi/sbi_platform.h>
|
|
#include <sbi/sbi_trap.h>
|
|
#include <sbi/riscv_asm.h>
|
|
|
|
static inline unsigned long sbi_ecall_vendor_id(void)
|
|
{
|
|
return SBI_EXT_VENDOR_START +
|
|
(csr_read(CSR_MVENDORID) &
|
|
(SBI_EXT_VENDOR_END - SBI_EXT_VENDOR_START));
|
|
}
|
|
|
|
static int sbi_ecall_vendor_probe(unsigned long extid,
|
|
unsigned long *out_val)
|
|
{
|
|
if (!sbi_platform_vendor_ext_check(sbi_platform_thishart_ptr()))
|
|
*out_val = 0;
|
|
else
|
|
*out_val = 1;
|
|
return 0;
|
|
}
|
|
|
|
static int sbi_ecall_vendor_handler(unsigned long extid, unsigned long funcid,
|
|
const struct sbi_trap_regs *regs,
|
|
unsigned long *out_val,
|
|
struct sbi_trap_info *out_trap)
|
|
{
|
|
if (!sbi_platform_vendor_ext_check(sbi_platform_thishart_ptr()))
|
|
return SBI_ERR_NOT_SUPPORTED;
|
|
|
|
return sbi_platform_vendor_ext_provider(sbi_platform_thishart_ptr(),
|
|
funcid, regs,
|
|
out_val, out_trap);
|
|
}
|
|
|
|
struct sbi_ecall_extension ecall_vendor;
|
|
|
|
static int sbi_ecall_vendor_register_extensions(void)
|
|
{
|
|
unsigned long extid = sbi_ecall_vendor_id();
|
|
|
|
ecall_vendor.extid_start = extid;
|
|
ecall_vendor.extid_end = extid;
|
|
|
|
return sbi_ecall_register_extension(&ecall_vendor);
|
|
}
|
|
|
|
struct sbi_ecall_extension ecall_vendor = {
|
|
.extid_start = SBI_EXT_VENDOR_START,
|
|
.extid_end = SBI_EXT_VENDOR_END,
|
|
.register_extensions = sbi_ecall_vendor_register_extensions,
|
|
.probe = sbi_ecall_vendor_probe,
|
|
.handle = sbi_ecall_vendor_handler,
|
|
};
|