mirror of
https://github.com/yuzu-emu/unicorn.git
synced 2025-03-24 22:15:07 +00:00
target/riscv: Add Hypervisor trap return support
Backports commit e3fba4bab668a41f7cec6405c5aeb21497bd7c83 from qemu
This commit is contained in:
parent
3e3bdf836b
commit
fcc30eac4d
|
@ -72,6 +72,8 @@ target_ulong helper_csrrc(CPURISCVState *env, target_ulong src,
|
||||||
|
|
||||||
target_ulong helper_sret(CPURISCVState *env, target_ulong cpu_pc_deb)
|
target_ulong helper_sret(CPURISCVState *env, target_ulong cpu_pc_deb)
|
||||||
{
|
{
|
||||||
|
target_ulong prev_priv, prev_virt, mstatus;
|
||||||
|
|
||||||
if (!(env->priv >= PRV_S)) {
|
if (!(env->priv >= PRV_S)) {
|
||||||
riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
|
riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
|
||||||
}
|
}
|
||||||
|
@ -86,16 +88,46 @@ target_ulong helper_sret(CPURISCVState *env, target_ulong cpu_pc_deb)
|
||||||
riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
|
riscv_raise_exception(env, RISCV_EXCP_ILLEGAL_INST, GETPC());
|
||||||
}
|
}
|
||||||
|
|
||||||
target_ulong mstatus = env->mstatus;
|
mstatus = env->mstatus;
|
||||||
target_ulong prev_priv = get_field(mstatus, MSTATUS_SPP);
|
|
||||||
mstatus = set_field(mstatus,
|
if (riscv_has_ext(env, RVH) && !riscv_cpu_virt_enabled(env)) {
|
||||||
env->priv_ver >= PRIV_VERSION_1_10_0 ?
|
/* We support Hypervisor extensions and virtulisation is disabled */
|
||||||
MSTATUS_SIE : MSTATUS_UIE << prev_priv,
|
target_ulong hstatus = env->hstatus;
|
||||||
get_field(mstatus, MSTATUS_SPIE));
|
|
||||||
mstatus = set_field(mstatus, MSTATUS_SPIE, 1);
|
prev_priv = get_field(mstatus, MSTATUS_SPP);
|
||||||
mstatus = set_field(mstatus, MSTATUS_SPP, PRV_U);
|
prev_virt = get_field(hstatus, HSTATUS_SPV);
|
||||||
|
|
||||||
|
hstatus = set_field(hstatus, HSTATUS_SPV,
|
||||||
|
get_field(hstatus, HSTATUS_SP2V));
|
||||||
|
mstatus = set_field(mstatus, MSTATUS_SPP,
|
||||||
|
get_field(hstatus, HSTATUS_SP2P));
|
||||||
|
hstatus = set_field(hstatus, HSTATUS_SP2V, 0);
|
||||||
|
hstatus = set_field(hstatus, HSTATUS_SP2P, 0);
|
||||||
|
mstatus = set_field(mstatus, SSTATUS_SIE,
|
||||||
|
get_field(mstatus, SSTATUS_SPIE));
|
||||||
|
mstatus = set_field(mstatus, SSTATUS_SPIE, 1);
|
||||||
|
|
||||||
|
env->mstatus = mstatus;
|
||||||
|
env->hstatus = hstatus;
|
||||||
|
|
||||||
|
if (prev_virt) {
|
||||||
|
riscv_cpu_swap_hypervisor_regs(env);
|
||||||
|
}
|
||||||
|
|
||||||
|
riscv_cpu_set_virt_enabled(env, prev_virt);
|
||||||
|
} else {
|
||||||
|
prev_priv = get_field(mstatus, MSTATUS_SPP);
|
||||||
|
|
||||||
|
mstatus = set_field(mstatus,
|
||||||
|
env->priv_ver >= PRIV_VERSION_1_10_0 ?
|
||||||
|
MSTATUS_SIE : MSTATUS_UIE << prev_priv,
|
||||||
|
get_field(mstatus, MSTATUS_SPIE));
|
||||||
|
mstatus = set_field(mstatus, MSTATUS_SPIE, 1);
|
||||||
|
mstatus = set_field(mstatus, MSTATUS_SPP, PRV_U);
|
||||||
|
env->mstatus = mstatus;
|
||||||
|
}
|
||||||
|
|
||||||
riscv_cpu_set_mode(env, prev_priv);
|
riscv_cpu_set_mode(env, prev_priv);
|
||||||
env->mstatus = mstatus;
|
|
||||||
|
|
||||||
return retpc;
|
return retpc;
|
||||||
}
|
}
|
||||||
|
@ -113,14 +145,24 @@ target_ulong helper_mret(CPURISCVState *env, target_ulong cpu_pc_deb)
|
||||||
|
|
||||||
target_ulong mstatus = env->mstatus;
|
target_ulong mstatus = env->mstatus;
|
||||||
target_ulong prev_priv = get_field(mstatus, MSTATUS_MPP);
|
target_ulong prev_priv = get_field(mstatus, MSTATUS_MPP);
|
||||||
|
target_ulong prev_virt = get_field(mstatus, MSTATUS_MPV);
|
||||||
mstatus = set_field(mstatus,
|
mstatus = set_field(mstatus,
|
||||||
env->priv_ver >= PRIV_VERSION_1_10_0 ?
|
env->priv_ver >= PRIV_VERSION_1_10_0 ?
|
||||||
MSTATUS_MIE : MSTATUS_UIE << prev_priv,
|
MSTATUS_MIE : MSTATUS_UIE << prev_priv,
|
||||||
get_field(mstatus, MSTATUS_MPIE));
|
get_field(mstatus, MSTATUS_MPIE));
|
||||||
mstatus = set_field(mstatus, MSTATUS_MPIE, 1);
|
mstatus = set_field(mstatus, MSTATUS_MPIE, 1);
|
||||||
mstatus = set_field(mstatus, MSTATUS_MPP, PRV_U);
|
mstatus = set_field(mstatus, MSTATUS_MPP, PRV_U);
|
||||||
riscv_cpu_set_mode(env, prev_priv);
|
mstatus = set_field(mstatus, MSTATUS_MPV, 0);
|
||||||
env->mstatus = mstatus;
|
env->mstatus = mstatus;
|
||||||
|
riscv_cpu_set_mode(env, prev_priv);
|
||||||
|
|
||||||
|
if (riscv_has_ext(env, RVH)) {
|
||||||
|
if (prev_virt) {
|
||||||
|
riscv_cpu_swap_hypervisor_regs(env);
|
||||||
|
}
|
||||||
|
|
||||||
|
riscv_cpu_set_virt_enabled(env, prev_virt);
|
||||||
|
}
|
||||||
|
|
||||||
return retpc;
|
return retpc;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in a new issue