mirror of
https://github.com/riscv-software-src/opensbi.git
synced 2025-08-24 15:31:22 +01:00
lib: sbi: fwft: add support for SBI_FWFT_PTE_AD_HW_UPDATING
Add support for SBI_FWFT_PTE_AD_HW_UPDATING based on SVADU presence. Signed-off-by: Clément Léger <cleger@rivosinc.com> Reviewed-by: Anup Patel <anup@brainfault.org>
This commit is contained in:

committed by
Anup Patel

parent
c97a1d5891
commit
e9ee9678ba
@@ -100,6 +100,47 @@ static int fwft_get_misaligned_delegation(struct fwft_config *conf,
|
||||
return SBI_OK;
|
||||
}
|
||||
|
||||
static int fwft_adue_supported(struct fwft_config *conf)
|
||||
{
|
||||
if (!sbi_hart_has_extension(sbi_scratch_thishart_ptr(),
|
||||
SBI_HART_EXT_SVADU))
|
||||
return SBI_ENOTSUPP;
|
||||
|
||||
return SBI_OK;
|
||||
}
|
||||
|
||||
static int fwft_set_adue(struct fwft_config *conf, unsigned long value)
|
||||
{
|
||||
if (value)
|
||||
#if __riscv_xlen == 32
|
||||
csr_set(CSR_MENVCFGH, ENVCFG_ADUE >> 32);
|
||||
#else
|
||||
csr_set(CSR_MENVCFG, ENVCFG_ADUE);
|
||||
#endif
|
||||
else
|
||||
#if __riscv_xlen == 32
|
||||
csr_clear(CSR_MENVCFGH, ENVCFG_ADUE >> 32);
|
||||
#else
|
||||
csr_clear(CSR_MENVCFG, ENVCFG_ADUE);
|
||||
#endif
|
||||
|
||||
return SBI_OK;
|
||||
}
|
||||
|
||||
static int fwft_get_adue(struct fwft_config *conf, unsigned long *value)
|
||||
{
|
||||
unsigned long cfg;
|
||||
|
||||
#if __riscv_xlen == 32
|
||||
cfg = csr_read(CSR_MENVCFGH) & (ENVCFG_ADUE >> 32);
|
||||
#else
|
||||
cfg = csr_read(CSR_MENVCFG) & ENVCFG_ADUE;
|
||||
#endif
|
||||
*value = cfg != 0;
|
||||
|
||||
return SBI_OK;
|
||||
}
|
||||
|
||||
static struct fwft_config* get_feature_config(enum sbi_fwft_feature_t feature)
|
||||
{
|
||||
int i;
|
||||
@@ -185,6 +226,12 @@ static const struct fwft_feature features[] =
|
||||
.set = fwft_set_misaligned_delegation,
|
||||
.get = fwft_get_misaligned_delegation,
|
||||
},
|
||||
{
|
||||
.id = SBI_FWFT_PTE_AD_HW_UPDATING,
|
||||
.supported = fwft_adue_supported,
|
||||
.set = fwft_set_adue,
|
||||
.get = fwft_get_adue,
|
||||
},
|
||||
};
|
||||
|
||||
int sbi_fwft_init(struct sbi_scratch *scratch, bool cold_boot)
|
||||
|
@@ -45,6 +45,10 @@ struct sbi_hsm_data {
|
||||
unsigned long saved_mie;
|
||||
unsigned long saved_mip;
|
||||
unsigned long saved_medeleg;
|
||||
unsigned long saved_menvcfg;
|
||||
#if __riscv_xlen == 32
|
||||
unsigned long saved_menvcfgh;
|
||||
#endif
|
||||
atomic_t start_ticket;
|
||||
};
|
||||
|
||||
@@ -419,6 +423,10 @@ void __sbi_hsm_suspend_non_ret_save(struct sbi_scratch *scratch)
|
||||
hdata->saved_mie = csr_read(CSR_MIE);
|
||||
hdata->saved_mip = csr_read(CSR_MIP) & (MIP_SSIP | MIP_STIP);
|
||||
hdata->saved_medeleg = csr_read(CSR_MEDELEG);
|
||||
#if __riscv_xlen == 32
|
||||
hdata->saved_menvcfgh = csr_read(CSR_MENVCFGH);
|
||||
#endif
|
||||
hdata->saved_menvcfg = csr_read(CSR_MENVCFG);
|
||||
}
|
||||
|
||||
static void __sbi_hsm_suspend_non_ret_restore(struct sbi_scratch *scratch)
|
||||
@@ -426,6 +434,10 @@ static void __sbi_hsm_suspend_non_ret_restore(struct sbi_scratch *scratch)
|
||||
struct sbi_hsm_data *hdata = sbi_scratch_offset_ptr(scratch,
|
||||
hart_data_offset);
|
||||
|
||||
csr_write(CSR_MENVCFG, hdata->saved_menvcfg);
|
||||
#if __riscv_xlen == 32
|
||||
csr_write(CSR_MENVCFGH, hdata->saved_menvcfgh);
|
||||
#endif
|
||||
csr_write(CSR_MEDELEG, hdata->saved_medeleg);
|
||||
csr_write(CSR_MIE, hdata->saved_mie);
|
||||
csr_set(CSR_MIP, (hdata->saved_mip & (MIP_SSIP | MIP_STIP)));
|
||||
|
Reference in New Issue
Block a user