Depending on the HCR_EL2.{E2H,TGE} values, SCTLR_EL2 has different
RES0/RES1 constraints.

Let's handle that.

Signed-off-by: Marc Zyngier <[email protected]>
---
 arch/arm64/kvm/sys_regs.c | 28 +++++++++++++++++++++++++++-
 1 file changed, 27 insertions(+), 1 deletion(-)

diff --git a/arch/arm64/kvm/sys_regs.c b/arch/arm64/kvm/sys_regs.c
index 0bd6a66b621e..1d896113f1f8 100644
--- a/arch/arm64/kvm/sys_regs.c
+++ b/arch/arm64/kvm/sys_regs.c
@@ -415,6 +415,32 @@ static bool access_rw(struct kvm_vcpu *vcpu,
        return true;
 }
 
+static bool access_sctlr_el2(struct kvm_vcpu *vcpu,
+                            struct sys_reg_params *p,
+                            const struct sys_reg_desc *r)
+{
+       if (el12_reg(p) && forward_nv_traps(vcpu))
+               return false;
+
+       if (p->is_write) {
+               u64 val = p->regval;
+
+               if (vcpu_el2_e2h_is_set(vcpu) && vcpu_el2_tge_is_set(vcpu)) {
+                       val &= ~SCTLR_EL1_RES0;
+                       val |=  SCTLR_EL1_RES1;
+               } else {
+                       val &= ~SCTLR_EL2_RES0;
+                       val |=  SCTLR_EL2_RES1;
+               }
+
+               vcpu_write_sys_reg(vcpu, val, r->reg);
+       } else {
+               p->regval = vcpu_read_sys_reg(vcpu, r->reg);
+       }
+
+       return true;
+}
+
 /*
  * See note at ARMv7 ARM B1.14.4 (TL;DR: S/W ops are not easily virtualized).
  */
@@ -2300,7 +2326,7 @@ static const struct sys_reg_desc sys_reg_descs[] = {
        { SYS_DESC(SYS_VPIDR_EL2), access_rw, reset_vpidr, VPIDR_EL2 },
        { SYS_DESC(SYS_VMPIDR_EL2), access_rw, reset_vmpidr, VMPIDR_EL2 },
 
-       { SYS_DESC(SYS_SCTLR_EL2), access_rw, reset_val, SCTLR_EL2, 0 },
+       { SYS_DESC(SYS_SCTLR_EL2), access_sctlr_el2, reset_val, SCTLR_EL2, 
SCTLR_EL2_RES1 },
        { SYS_DESC(SYS_ACTLR_EL2), access_rw, reset_val, ACTLR_EL2, 0 },
        { SYS_DESC(SYS_HCR_EL2), access_rw, reset_val, HCR_EL2, 0 },
        { SYS_DESC(SYS_MDCR_EL2), access_rw, reset_val, MDCR_EL2, 0 },
-- 
2.20.1

_______________________________________________
kvmarm mailing list
[email protected]
https://lists.cs.columbia.edu/mailman/listinfo/kvmarm

Reply via email to