forked from Mirrors/opensbi
lib: sbi: Add sbi_hart_reinit() function
We add sbi_hart_reinit() function which will re-initialize HART CSRs assuming HART features are already detected. This new function will be useful in re-initializing HART after it resumes from HSM SUSPENDED state. Signed-off-by: Anup Patel <anup.patel@wdc.com> Reviewed-by: Atish Patra <atish.patra@wdc.com>
This commit is contained in:
@@ -27,6 +27,7 @@ enum sbi_hart_features {
|
|||||||
|
|
||||||
struct sbi_scratch;
|
struct sbi_scratch;
|
||||||
|
|
||||||
|
int sbi_hart_reinit(struct sbi_scratch *scratch);
|
||||||
int sbi_hart_init(struct sbi_scratch *scratch, bool cold_boot);
|
int sbi_hart_init(struct sbi_scratch *scratch, bool cold_boot);
|
||||||
|
|
||||||
extern void (*sbi_hart_expected_trap)(void);
|
extern void (*sbi_hart_expected_trap)(void);
|
||||||
|
@@ -430,10 +430,25 @@ __mhpm_skip:
|
|||||||
hfeatures->features |= SBI_HART_HAS_TIME;
|
hfeatures->features |= SBI_HART_HAS_TIME;
|
||||||
}
|
}
|
||||||
|
|
||||||
int sbi_hart_init(struct sbi_scratch *scratch, bool cold_boot)
|
int sbi_hart_reinit(struct sbi_scratch *scratch)
|
||||||
{
|
{
|
||||||
int rc;
|
int rc;
|
||||||
|
|
||||||
|
mstatus_init(scratch);
|
||||||
|
|
||||||
|
rc = fp_init(scratch);
|
||||||
|
if (rc)
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
rc = delegate_traps(scratch);
|
||||||
|
if (rc)
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int sbi_hart_init(struct sbi_scratch *scratch, bool cold_boot)
|
||||||
|
{
|
||||||
if (cold_boot) {
|
if (cold_boot) {
|
||||||
if (misa_extension('H'))
|
if (misa_extension('H'))
|
||||||
sbi_hart_expected_trap = &__sbi_expected_trap_hext;
|
sbi_hart_expected_trap = &__sbi_expected_trap_hext;
|
||||||
@@ -447,17 +462,7 @@ int sbi_hart_init(struct sbi_scratch *scratch, bool cold_boot)
|
|||||||
|
|
||||||
hart_detect_features(scratch);
|
hart_detect_features(scratch);
|
||||||
|
|
||||||
mstatus_init(scratch);
|
return sbi_hart_reinit(scratch);
|
||||||
|
|
||||||
rc = fp_init(scratch);
|
|
||||||
if (rc)
|
|
||||||
return rc;
|
|
||||||
|
|
||||||
rc = delegate_traps(scratch);
|
|
||||||
if (rc)
|
|
||||||
return rc;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void __attribute__((noreturn)) sbi_hart_hang(void)
|
void __attribute__((noreturn)) sbi_hart_hang(void)
|
||||||
|
Reference in New Issue
Block a user