diff options
author | Anup Patel <anup.patel@wdc.com> | 2019-04-05 11:38:57 +0300 |
---|---|---|
committer | Anup Patel <anup@brainfault.org> | 2019-09-30 12:48:06 +0300 |
commit | 1a5614e971cf44e08342c2b1639fa3be544b0202 (patch) | |
tree | 0afa5525ef174e565eec10f73a4a64a58dc31c72 /lib/sbi/sbi_hart.c | |
parent | 0089897d41b5b2382acba1c2c9f9386edad75228 (diff) | |
download | opensbi-1a5614e971cf44e08342c2b1639fa3be544b0202.tar.xz |
lib: Extend sbi_hart_switch_mode() to support hypervisor extension
This patch extends sbi_hart_switch_mode() to support entering
VS/VU modes when hypervisor extension is available.
Signed-off-by: Anup Patel <anup.patel@wdc.com>
Diffstat (limited to 'lib/sbi/sbi_hart.c')
-rw-r--r-- | lib/sbi/sbi_hart.c | 27 |
1 files changed, 25 insertions, 2 deletions
diff --git a/lib/sbi/sbi_hart.c b/lib/sbi/sbi_hart.c index 6dac84b..b0c087a 100644 --- a/lib/sbi/sbi_hart.c +++ b/lib/sbi/sbi_hart.c @@ -241,9 +241,14 @@ void __attribute__((noreturn)) sbi_hart_hang(void) void __attribute__((noreturn)) sbi_hart_switch_mode(unsigned long arg0, unsigned long arg1, - unsigned long next_addr, unsigned long next_mode) + unsigned long next_addr, unsigned long next_mode, + bool next_virt) { +#if __riscv_xlen == 32 + unsigned long val, valH; +#else unsigned long val; +#endif switch (next_mode) { case PRV_M: @@ -263,7 +268,25 @@ sbi_hart_switch_mode(unsigned long arg0, unsigned long arg1, val = csr_read(CSR_MSTATUS); val = INSERT_FIELD(val, MSTATUS_MPP, next_mode); val = INSERT_FIELD(val, MSTATUS_MPIE, 0); - +#if __riscv_xlen == 32 + if (misa_extension('H')) { + valH = csr_read(CSR_MSTATUSH); + valH = INSERT_FIELD(valH, MSTATUSH_MTL, 0); + if (next_virt) + valH = INSERT_FIELD(valH, MSTATUSH_MPV, 1); + else + valH = INSERT_FIELD(valH, MSTATUSH_MPV, 0); + csr_write(CSR_MSTATUSH, valH); + } +#else + if (misa_extension('H')) { + val = INSERT_FIELD(val, MSTATUS_MTL, 0); + if (next_virt) + val = INSERT_FIELD(val, MSTATUS_MPV, 1); + else + val = INSERT_FIELD(val, MSTATUS_MPV, 0); + } +#endif csr_write(CSR_MSTATUS, val); csr_write(CSR_MEPC, next_addr); |