When VMM needs to replay a synchronous external abort (SEA) into
guest, it may want to emulate ESR_ELx.ISS and ESR_ELx.ISS2.

Extend the KVM_SET_VCPU_EVENTS ioctl to allow userspace to supply
ESR_ELx when injecting SEA into the guest, similar to what userspace can
do when injecting SError.

Signed-off-by: Jiaqi Yan <jiaqi...@google.com>
---
 arch/arm64/include/asm/kvm_emulate.h |  9 ++++++--
 arch/arm64/include/uapi/asm/kvm.h    |  6 ++++--
 arch/arm64/kvm/emulate-nested.c      |  6 +++---
 arch/arm64/kvm/guest.c               | 31 +++++++++++++++++-----------
 arch/arm64/kvm/inject_fault.c        | 16 +++++++-------
 5 files changed, 41 insertions(+), 27 deletions(-)

diff --git a/arch/arm64/include/asm/kvm_emulate.h 
b/arch/arm64/include/asm/kvm_emulate.h
index fa8a08a1ccd5c..80315d21cda13 100644
--- a/arch/arm64/include/asm/kvm_emulate.h
+++ b/arch/arm64/include/asm/kvm_emulate.h
@@ -46,9 +46,14 @@ void kvm_skip_instr32(struct kvm_vcpu *vcpu);
 
 void kvm_inject_undefined(struct kvm_vcpu *vcpu);
 int kvm_inject_serror_esr(struct kvm_vcpu *vcpu, u64 esr);
-int kvm_inject_sea(struct kvm_vcpu *vcpu, bool iabt, u64 addr);
+int kvm_inject_sea_esr(struct kvm_vcpu *vcpu, bool iabt, u64 addr, u64 esr);
 void kvm_inject_size_fault(struct kvm_vcpu *vcpu);
 
+static inline int kvm_inject_sea(struct kvm_vcpu *vcpu, bool iabt, u64 addr)
+{
+       return kvm_inject_sea_esr(vcpu, iabt, addr, 0);
+}
+
 static inline int kvm_inject_sea_dabt(struct kvm_vcpu *vcpu, u64 addr)
 {
        return kvm_inject_sea(vcpu, false, addr);
@@ -76,7 +81,7 @@ void kvm_vcpu_wfi(struct kvm_vcpu *vcpu);
 void kvm_emulate_nested_eret(struct kvm_vcpu *vcpu);
 int kvm_inject_nested_sync(struct kvm_vcpu *vcpu, u64 esr_el2);
 int kvm_inject_nested_irq(struct kvm_vcpu *vcpu);
-int kvm_inject_nested_sea(struct kvm_vcpu *vcpu, bool iabt, u64 addr);
+int kvm_inject_nested_sea(struct kvm_vcpu *vcpu, bool iabt, u64 addr, u64 esr);
 int kvm_inject_nested_serror(struct kvm_vcpu *vcpu, u64 esr);
 
 static inline void kvm_inject_nested_sve_trap(struct kvm_vcpu *vcpu)
diff --git a/arch/arm64/include/uapi/asm/kvm.h 
b/arch/arm64/include/uapi/asm/kvm.h
index 643e8c4825451..406d6e67df822 100644
--- a/arch/arm64/include/uapi/asm/kvm.h
+++ b/arch/arm64/include/uapi/asm/kvm.h
@@ -185,11 +185,13 @@ struct kvm_vcpu_events {
                __u8 serror_has_esr;
                __u8 ext_dabt_pending;
                __u8 ext_iabt_pending;
+               __u8 ext_abt_has_esr;
                /* Align it to 8 bytes */
-               __u8 pad[4];
+               __u8 pad[3];
                __u64 serror_esr;
+               __u64 ext_abt_esr;
        } exception;
-       __u32 reserved[12];
+       __u32 reserved[10];
 };
 
 struct kvm_arm_copy_mte_tags {
diff --git a/arch/arm64/kvm/emulate-nested.c b/arch/arm64/kvm/emulate-nested.c
index 90cb4b7ae0ff7..fa5e7fc701bfb 100644
--- a/arch/arm64/kvm/emulate-nested.c
+++ b/arch/arm64/kvm/emulate-nested.c
@@ -2827,10 +2827,10 @@ int kvm_inject_nested_irq(struct kvm_vcpu *vcpu)
        return kvm_inject_nested(vcpu, 0, except_type_irq);
 }
 
-int kvm_inject_nested_sea(struct kvm_vcpu *vcpu, bool iabt, u64 addr)
+int kvm_inject_nested_sea(struct kvm_vcpu *vcpu, bool iabt, u64 addr, u64 esr)
 {
-       u64 esr = FIELD_PREP(ESR_ELx_EC_MASK,
-                            iabt ? ESR_ELx_EC_IABT_LOW : ESR_ELx_EC_DABT_LOW);
+       esr |= FIELD_PREP(ESR_ELx_EC_MASK,
+                         iabt ? ESR_ELx_EC_IABT_LOW : ESR_ELx_EC_DABT_LOW);
        esr |= ESR_ELx_FSC_EXTABT | ESR_ELx_IL;
 
        vcpu_write_sys_reg(vcpu, FAR_EL2, addr);
diff --git a/arch/arm64/kvm/guest.c b/arch/arm64/kvm/guest.c
index d3c7b5015f20e..018bf0d5277ec 100644
--- a/arch/arm64/kvm/guest.c
+++ b/arch/arm64/kvm/guest.c
@@ -847,27 +847,40 @@ static void commit_pending_events(struct kvm_vcpu *vcpu)
        kvm_call_hyp(__kvm_adjust_pc, vcpu);
 }
 
+#define ESR_EXCLUDE_ISS(name) ((name##_has_esr) && ((name##_esr) & 
~ESR_ELx_ISS_MASK))
+
 int __kvm_arm_vcpu_set_events(struct kvm_vcpu *vcpu,
                              struct kvm_vcpu_events *events)
 {
        bool serror_pending = events->exception.serror_pending;
-       bool has_esr = events->exception.serror_has_esr;
+       bool serror_has_esr = events->exception.serror_has_esr;
        bool ext_dabt_pending = events->exception.ext_dabt_pending;
        bool ext_iabt_pending = events->exception.ext_iabt_pending;
-       u64 esr = events->exception.serror_esr;
+       bool ext_abt_has_esr = events->exception.ext_abt_has_esr;
+       u64 serror_esr = events->exception.serror_esr;
+       u64 ext_abt_esr = events->exception.ext_abt_esr;
        int ret = 0;
 
+       if (!cpus_have_final_cap(ARM64_HAS_RAS_EXTN) &&
+           (serror_has_esr || ext_abt_has_esr))
+               return -EINVAL;
+
+       if (ESR_EXCLUDE_ISS(serror) || ESR_EXCLUDE_ISS(ext_abt))
+               return -EINVAL;
+
        /* DABT and IABT cannot happen at the same time. */
        if (ext_dabt_pending && ext_iabt_pending)
                return -EINVAL;
+
        /*
         * Immediately commit the pending SEA to the vCPU's architectural
         * state which is necessary since we do not return a pending SEA
         * to userspace via KVM_GET_VCPU_EVENTS.
         */
        if (ext_dabt_pending || ext_iabt_pending) {
-               ret = kvm_inject_sea(vcpu, ext_iabt_pending,
-                                    kvm_vcpu_get_hfar(vcpu));
+               ret = kvm_inject_sea_esr(vcpu, ext_iabt_pending,
+                                        kvm_vcpu_get_hfar(vcpu),
+                                        ext_abt_has_esr ? ext_abt_esr : 0);
                commit_pending_events(vcpu);
        }
 
@@ -877,14 +890,8 @@ int __kvm_arm_vcpu_set_events(struct kvm_vcpu *vcpu,
        if (!serror_pending)
                return 0;
 
-       if (!cpus_have_final_cap(ARM64_HAS_RAS_EXTN) && has_esr)
-               return -EINVAL;
-
-       if (has_esr && (esr & ~ESR_ELx_ISS_MASK))
-               return -EINVAL;
-
-       if (has_esr)
-               ret = kvm_inject_serror_esr(vcpu, esr);
+       if (serror_has_esr)
+               ret = kvm_inject_serror_esr(vcpu, serror_esr);
        else
                ret = kvm_inject_serror(vcpu);
 
diff --git a/arch/arm64/kvm/inject_fault.c b/arch/arm64/kvm/inject_fault.c
index 6745f38b64f9c..410b2d6f6ae4c 100644
--- a/arch/arm64/kvm/inject_fault.c
+++ b/arch/arm64/kvm/inject_fault.c
@@ -102,11 +102,11 @@ static bool effective_sctlr2_nmea(struct kvm_vcpu *vcpu)
        return __effective_sctlr2_bit(vcpu, SCTLR2_EL1_NMEA_SHIFT);
 }
 
-static void inject_abt64(struct kvm_vcpu *vcpu, bool is_iabt, unsigned long 
addr)
+static void inject_abt64(struct kvm_vcpu *vcpu, bool is_iabt,
+                        unsigned long addr, u64 esr)
 {
        unsigned long cpsr = *vcpu_cpsr(vcpu);
        bool is_aarch32 = vcpu_mode_is_32bit(vcpu);
-       u64 esr = 0;
 
        /* This delight is brought to you by FEAT_DoubleFault2. */
        if (effective_sctlr2_ease(vcpu))
@@ -199,12 +199,12 @@ static void inject_abt32(struct kvm_vcpu *vcpu, bool 
is_pabt, u32 addr)
        vcpu_write_sys_reg(vcpu, far, FAR_EL1);
 }
 
-static void __kvm_inject_sea(struct kvm_vcpu *vcpu, bool iabt, u64 addr)
+static void __kvm_inject_sea(struct kvm_vcpu *vcpu, bool iabt, u64 addr, u64 
esr)
 {
        if (vcpu_el1_is_32bit(vcpu))
                inject_abt32(vcpu, iabt, addr);
        else
-               inject_abt64(vcpu, iabt, addr);
+               inject_abt64(vcpu, iabt, addr, esr);
 }
 
 static bool kvm_sea_target_is_el2(struct kvm_vcpu *vcpu)
@@ -219,14 +219,14 @@ static bool kvm_sea_target_is_el2(struct kvm_vcpu *vcpu)
               (__vcpu_sys_reg(vcpu, HCRX_EL2) & HCRX_EL2_TMEA);
 }
 
-int kvm_inject_sea(struct kvm_vcpu *vcpu, bool iabt, u64 addr)
+int kvm_inject_sea_esr(struct kvm_vcpu *vcpu, bool iabt, u64 addr, u64 esr)
 {
        lockdep_assert_held(&vcpu->mutex);
 
        if (is_nested_ctxt(vcpu) && kvm_sea_target_is_el2(vcpu))
-               return kvm_inject_nested_sea(vcpu, iabt, addr);
+               return kvm_inject_nested_sea(vcpu, iabt, addr, esr);
 
-       __kvm_inject_sea(vcpu, iabt, addr);
+       __kvm_inject_sea(vcpu, iabt, addr, esr);
        return 1;
 }
 
@@ -237,7 +237,7 @@ void kvm_inject_size_fault(struct kvm_vcpu *vcpu)
        addr  = kvm_vcpu_get_fault_ipa(vcpu);
        addr |= kvm_vcpu_get_hfar(vcpu) & GENMASK(11, 0);
 
-       __kvm_inject_sea(vcpu, kvm_vcpu_trap_is_iabt(vcpu), addr);
+       __kvm_inject_sea(vcpu, kvm_vcpu_trap_is_iabt(vcpu), addr, 0);
 
        /*
         * If AArch64 or LPAE, set FSC to 0 to indicate an Address
-- 
2.50.1.565.gc32cd1483b-goog


Reply via email to