mirror of
https://github.com/riscv-software-src/opensbi.git
synced 2025-08-24 23:41:23 +01:00
lib: sbi: fwft: add support for SBI_FWFT_MISALIGNED_EXC_DELEG
Add support for SBI_FWFT_MISALIGNED_EXC_DELEG withing FWFT support. This support allows to delegate misaligned accesses traps. 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
aa5a859369
commit
c97a1d5891
@@ -32,6 +32,8 @@ static unsigned long fwft_ptr_offset;
|
|||||||
#define fwft_set_hart_state_ptr(__scratch, __phs) \
|
#define fwft_set_hart_state_ptr(__scratch, __phs) \
|
||||||
sbi_scratch_write_type((__scratch), void *, fwft_ptr_offset, (__phs))
|
sbi_scratch_write_type((__scratch), void *, fwft_ptr_offset, (__phs))
|
||||||
|
|
||||||
|
#define MIS_DELEG (1UL << CAUSE_MISALIGNED_LOAD | 1UL << CAUSE_MISALIGNED_STORE)
|
||||||
|
|
||||||
struct fwft_config;
|
struct fwft_config;
|
||||||
|
|
||||||
struct fwft_feature {
|
struct fwft_feature {
|
||||||
@@ -71,6 +73,33 @@ static bool fwft_is_defined_feature(enum sbi_fwft_feature_t feature)
|
|||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int fwft_misaligned_delegation_supported(struct fwft_config *conf)
|
||||||
|
{
|
||||||
|
if (!misa_extension('S'))
|
||||||
|
return SBI_ENOTSUPP;
|
||||||
|
|
||||||
|
return SBI_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int fwft_set_misaligned_delegation(struct fwft_config *conf,
|
||||||
|
unsigned long value)
|
||||||
|
{
|
||||||
|
if (value)
|
||||||
|
csr_set(CSR_MEDELEG, MIS_DELEG);
|
||||||
|
else
|
||||||
|
csr_clear(CSR_MEDELEG, MIS_DELEG);
|
||||||
|
|
||||||
|
return SBI_OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int fwft_get_misaligned_delegation(struct fwft_config *conf,
|
||||||
|
unsigned long *value)
|
||||||
|
{
|
||||||
|
*value = (csr_read(CSR_MEDELEG) & MIS_DELEG) != 0;
|
||||||
|
|
||||||
|
return SBI_OK;
|
||||||
|
}
|
||||||
|
|
||||||
static struct fwft_config* get_feature_config(enum sbi_fwft_feature_t feature)
|
static struct fwft_config* get_feature_config(enum sbi_fwft_feature_t feature)
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
@@ -148,7 +177,15 @@ int sbi_fwft_get(enum sbi_fwft_feature_t feature, unsigned long *out_val)
|
|||||||
return conf->feature->get(conf, out_val);
|
return conf->feature->get(conf, out_val);
|
||||||
}
|
}
|
||||||
|
|
||||||
static const struct fwft_feature features[] = {};
|
static const struct fwft_feature features[] =
|
||||||
|
{
|
||||||
|
{
|
||||||
|
.id = SBI_FWFT_MISALIGNED_EXC_DELEG,
|
||||||
|
.supported = fwft_misaligned_delegation_supported,
|
||||||
|
.set = fwft_set_misaligned_delegation,
|
||||||
|
.get = fwft_get_misaligned_delegation,
|
||||||
|
},
|
||||||
|
};
|
||||||
|
|
||||||
int sbi_fwft_init(struct sbi_scratch *scratch, bool cold_boot)
|
int sbi_fwft_init(struct sbi_scratch *scratch, bool cold_boot)
|
||||||
{
|
{
|
||||||
|
@@ -44,6 +44,7 @@ struct sbi_hsm_data {
|
|||||||
unsigned long suspend_type;
|
unsigned long suspend_type;
|
||||||
unsigned long saved_mie;
|
unsigned long saved_mie;
|
||||||
unsigned long saved_mip;
|
unsigned long saved_mip;
|
||||||
|
unsigned long saved_medeleg;
|
||||||
atomic_t start_ticket;
|
atomic_t start_ticket;
|
||||||
};
|
};
|
||||||
|
|
||||||
@@ -417,6 +418,7 @@ void __sbi_hsm_suspend_non_ret_save(struct sbi_scratch *scratch)
|
|||||||
|
|
||||||
hdata->saved_mie = csr_read(CSR_MIE);
|
hdata->saved_mie = csr_read(CSR_MIE);
|
||||||
hdata->saved_mip = csr_read(CSR_MIP) & (MIP_SSIP | MIP_STIP);
|
hdata->saved_mip = csr_read(CSR_MIP) & (MIP_SSIP | MIP_STIP);
|
||||||
|
hdata->saved_medeleg = csr_read(CSR_MEDELEG);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void __sbi_hsm_suspend_non_ret_restore(struct sbi_scratch *scratch)
|
static void __sbi_hsm_suspend_non_ret_restore(struct sbi_scratch *scratch)
|
||||||
@@ -424,6 +426,7 @@ static void __sbi_hsm_suspend_non_ret_restore(struct sbi_scratch *scratch)
|
|||||||
struct sbi_hsm_data *hdata = sbi_scratch_offset_ptr(scratch,
|
struct sbi_hsm_data *hdata = sbi_scratch_offset_ptr(scratch,
|
||||||
hart_data_offset);
|
hart_data_offset);
|
||||||
|
|
||||||
|
csr_write(CSR_MEDELEG, hdata->saved_medeleg);
|
||||||
csr_write(CSR_MIE, hdata->saved_mie);
|
csr_write(CSR_MIE, hdata->saved_mie);
|
||||||
csr_set(CSR_MIP, (hdata->saved_mip & (MIP_SSIP | MIP_STIP)));
|
csr_set(CSR_MIP, (hdata->saved_mip & (MIP_SSIP | MIP_STIP)));
|
||||||
}
|
}
|
||||||
|
Reference in New Issue
Block a user