// SPDX-License-Identifier: GPL-2.0-only
#include "test_util.h"
#include "kvm_util.h"
#include "processor.h"
#include "vmx.h"
#include "svm_util.h"

#define L2_GUEST_STACK_SIZE 256

/*
 * Arbitrary, never shoved into KVM/hardware, just need to avoid conflict with
 * the "real" exceptions used, #SS/#GP/#DF (12/13/8).
 */
#define FAKE_TRIPLE_FAULT_VECTOR        0xaa

/* Arbitrary 32-bit error code injected by this test. */
#define SS_ERROR_CODE 0xdeadbeef

/*
 * Bit '0' is set on Intel if the exception occurs while delivering a previous
 * event/exception.  AMD's wording is ambiguous, but presumably the bit is set
 * if the exception occurs while delivering an external event, e.g. NMI or INTR,
 * but not for exceptions that occur when delivering other exceptions or
 * software interrupts.
 *
 * Note, Intel's name for it, "External event", is misleading and much more
 * aligned with AMD's behavior, but the SDM is quite clear on its behavior.
 */
#define ERROR_CODE_EXT_FLAG     BIT(0)

/*
 * Bit '1' is set if the fault occurred when looking up a descriptor in the
 * IDT, which is the case here as the IDT is empty/NULL.
 */
#define ERROR_CODE_IDT_FLAG     BIT(1)

/*
 * The #GP that occurs when vectoring #SS should show the index into the IDT
 * for #SS, plus have the "IDT flag" set.
 */
#define GP_ERROR_CODE_AMD ((SS_VECTOR * 8) | ERROR_CODE_IDT_FLAG)
#define GP_ERROR_CODE_INTEL ((SS_VECTOR * 8) | ERROR_CODE_IDT_FLAG | ERROR_CODE_EXT_FLAG)

/*
 * Intel and AMD both shove '0' into the error code on #DF, regardless of what
 * led to the double fault.
 */
#define DF_ERROR_CODE 0

#define INTERCEPT_SS            (BIT_ULL(SS_VECTOR))
#define INTERCEPT_SS_DF         (INTERCEPT_SS | BIT_ULL(DF_VECTOR))
#define INTERCEPT_SS_GP_DF      (INTERCEPT_SS_DF | BIT_ULL(GP_VECTOR))

static void l2_ss_pending_test(void)
{
        GUEST_SYNC(SS_VECTOR);
}

static void l2_ss_injected_gp_test(void)
{
        GUEST_SYNC(GP_VECTOR);
}

static void l2_ss_injected_df_test(void)
{
        GUEST_SYNC(DF_VECTOR);
}

static void l2_ss_injected_tf_test(void)
{
        GUEST_SYNC(FAKE_TRIPLE_FAULT_VECTOR);
}

static void svm_run_l2(struct svm_test_data *svm, void *l2_code, int vector,
                       uint32_t error_code)
{
        struct vmcb *vmcb = svm->vmcb;
        struct vmcb_control_area *ctrl = &vmcb->control;

        vmcb->save.rip = (u64)l2_code;
        run_guest(vmcb, svm->vmcb_gpa);

        if (vector == FAKE_TRIPLE_FAULT_VECTOR)
                return;

        GUEST_ASSERT_EQ(ctrl->exit_code, (SVM_EXIT_EXCP_BASE + vector));
        GUEST_ASSERT_EQ(ctrl->exit_info_1, error_code);
        GUEST_ASSERT(!ctrl->int_state);
}

static void l1_svm_code(struct svm_test_data *svm)
{
        struct vmcb_control_area *ctrl = &svm->vmcb->control;
        unsigned long l2_guest_stack[L2_GUEST_STACK_SIZE];

        generic_svm_setup(svm, NULL, &l2_guest_stack[L2_GUEST_STACK_SIZE]);
        svm->vmcb->save.idtr.limit = 0;
        ctrl->intercept |= BIT_ULL(INTERCEPT_SHUTDOWN);

        ctrl->intercept_exceptions = INTERCEPT_SS_GP_DF;
        svm_run_l2(svm, l2_ss_pending_test, SS_VECTOR, SS_ERROR_CODE);
        svm_run_l2(svm, l2_ss_injected_gp_test, GP_VECTOR, GP_ERROR_CODE_AMD);

        ctrl->intercept_exceptions = INTERCEPT_SS_DF;
        svm_run_l2(svm, l2_ss_injected_df_test, DF_VECTOR, DF_ERROR_CODE);

        ctrl->intercept_exceptions = INTERCEPT_SS;
        svm_run_l2(svm, l2_ss_injected_tf_test, FAKE_TRIPLE_FAULT_VECTOR, 0);
        GUEST_ASSERT_EQ(ctrl->exit_code, SVM_EXIT_SHUTDOWN);

        GUEST_DONE();
}

static void vmx_run_l2(void *l2_code, int vector, uint32_t error_code)
{
        GUEST_ASSERT(!vmwrite(GUEST_RIP, (u64)l2_code));

        GUEST_ASSERT_EQ(vector == SS_VECTOR ? vmlaunch() : vmresume(), 0);

        if (vector == FAKE_TRIPLE_FAULT_VECTOR)
                return;

        GUEST_ASSERT_EQ(vmreadz(VM_EXIT_REASON), EXIT_REASON_EXCEPTION_NMI);
        GUEST_ASSERT_EQ((vmreadz(VM_EXIT_INTR_INFO) & 0xff), vector);
        GUEST_ASSERT_EQ(vmreadz(VM_EXIT_INTR_ERROR_CODE), error_code);
        GUEST_ASSERT(!vmreadz(GUEST_INTERRUPTIBILITY_INFO));
}

static void l1_vmx_code(struct vmx_pages *vmx)
{
        unsigned long l2_guest_stack[L2_GUEST_STACK_SIZE];

        GUEST_ASSERT_EQ(prepare_for_vmx_operation(vmx), true);

        GUEST_ASSERT_EQ(load_vmcs(vmx), true);

        prepare_vmcs(vmx, NULL, &l2_guest_stack[L2_GUEST_STACK_SIZE]);
        GUEST_ASSERT_EQ(vmwrite(GUEST_IDTR_LIMIT, 0), 0);

        /*
         * VMX disallows injecting an exception with error_code[31:16] != 0,
         * and hardware will never generate a VM-Exit with bits 31:16 set.
         * KVM should likewise truncate the "bad" userspace value.
         */
        GUEST_ASSERT_EQ(vmwrite(EXCEPTION_BITMAP, INTERCEPT_SS_GP_DF), 0);
        vmx_run_l2(l2_ss_pending_test, SS_VECTOR, (u16)SS_ERROR_CODE);
        vmx_run_l2(l2_ss_injected_gp_test, GP_VECTOR, GP_ERROR_CODE_INTEL);

        GUEST_ASSERT_EQ(vmwrite(EXCEPTION_BITMAP, INTERCEPT_SS_DF), 0);
        vmx_run_l2(l2_ss_injected_df_test, DF_VECTOR, DF_ERROR_CODE);

        GUEST_ASSERT_EQ(vmwrite(EXCEPTION_BITMAP, INTERCEPT_SS), 0);
        vmx_run_l2(l2_ss_injected_tf_test, FAKE_TRIPLE_FAULT_VECTOR, 0);
        GUEST_ASSERT_EQ(vmreadz(VM_EXIT_REASON), EXIT_REASON_TRIPLE_FAULT);

        GUEST_DONE();
}

static void __attribute__((__flatten__)) l1_guest_code(void *test_data)
{
        if (this_cpu_has(X86_FEATURE_SVM))
                l1_svm_code(test_data);
        else
                l1_vmx_code(test_data);
}

static void assert_ucall_vector(struct kvm_vcpu *vcpu, int vector)
{
        struct ucall uc;

        TEST_ASSERT_KVM_EXIT_REASON(vcpu, KVM_EXIT_IO);

        switch (get_ucall(vcpu, &uc)) {
        case UCALL_SYNC:
                TEST_ASSERT(vector == uc.args[1],
                            "Expected L2 to ask for %d, got %ld", vector, uc.args[1]);
                break;
        case UCALL_DONE:
                TEST_ASSERT(vector == -1,
                            "Expected L2 to ask for %d, L2 says it's done", vector);
                break;
        case UCALL_ABORT:
                REPORT_GUEST_ASSERT(uc);
                break;
        default:
                TEST_FAIL("Expected L2 to ask for %d, got unexpected ucall %lu", vector, uc.cmd);
        }
}

static void queue_ss_exception(struct kvm_vcpu *vcpu, bool inject)
{
        struct kvm_vcpu_events events;

        vcpu_events_get(vcpu, &events);

        TEST_ASSERT(!events.exception.pending,
                    "Vector %d unexpectedlt pending", events.exception.nr);
        TEST_ASSERT(!events.exception.injected,
                    "Vector %d unexpectedly injected", events.exception.nr);

        events.flags = KVM_VCPUEVENT_VALID_PAYLOAD;
        events.exception.pending = !inject;
        events.exception.injected = inject;
        events.exception.nr = SS_VECTOR;
        events.exception.has_error_code = true;
        events.exception.error_code = SS_ERROR_CODE;
        vcpu_events_set(vcpu, &events);
}

/*
 * Verify KVM_{G,S}ET_EVENTS play nice with pending vs. injected exceptions
 * when an exception is being queued for L2.  Specifically, verify that KVM
 * honors L1 exception intercept controls when a #SS is pending/injected,
 * triggers a #GP on vectoring the #SS, morphs to #DF if #GP isn't intercepted
 * by L1, and finally causes (nested) SHUTDOWN if #DF isn't intercepted by L1.
 */
int main(int argc, char *argv[])
{
        vm_vaddr_t nested_test_data_gva;
        struct kvm_vcpu_events events;
        struct kvm_vcpu *vcpu;
        struct kvm_vm *vm;

        TEST_REQUIRE(kvm_has_cap(KVM_CAP_EXCEPTION_PAYLOAD));
        TEST_REQUIRE(kvm_cpu_has(X86_FEATURE_SVM) || kvm_cpu_has(X86_FEATURE_VMX));

        vm = vm_create_with_one_vcpu(&vcpu, l1_guest_code);
        vm_enable_cap(vm, KVM_CAP_EXCEPTION_PAYLOAD, -2ul);

        if (kvm_cpu_has(X86_FEATURE_SVM))
                vcpu_alloc_svm(vm, &nested_test_data_gva);
        else
                vcpu_alloc_vmx(vm, &nested_test_data_gva);

        vcpu_args_set(vcpu, 1, nested_test_data_gva);

        /* Run L1 => L2.  L2 should sync and request #SS. */
        vcpu_run(vcpu);
        assert_ucall_vector(vcpu, SS_VECTOR);

        /* Pend #SS and request immediate exit.  #SS should still be pending. */
        queue_ss_exception(vcpu, false);
        vcpu->run->immediate_exit = true;
        vcpu_run_complete_io(vcpu);

        /* Verify the pending events comes back out the same as it went in. */
        vcpu_events_get(vcpu, &events);
        TEST_ASSERT_EQ(events.flags & KVM_VCPUEVENT_VALID_PAYLOAD,
                        KVM_VCPUEVENT_VALID_PAYLOAD);
        TEST_ASSERT_EQ(events.exception.pending, true);
        TEST_ASSERT_EQ(events.exception.nr, SS_VECTOR);
        TEST_ASSERT_EQ(events.exception.has_error_code, true);
        TEST_ASSERT_EQ(events.exception.error_code, SS_ERROR_CODE);

        /*
         * Run for real with the pending #SS, L1 should get a VM-Exit due to
         * #SS interception and re-enter L2 to request #GP (via injected #SS).
         */
        vcpu->run->immediate_exit = false;
        vcpu_run(vcpu);
        assert_ucall_vector(vcpu, GP_VECTOR);

        /*
         * Inject #SS, the #SS should bypass interception and cause #GP, which
         * L1 should intercept before KVM morphs it to #DF.  L1 should then
         * disable #GP interception and run L2 to request #DF (via #SS => #GP).
         */
        queue_ss_exception(vcpu, true);
        vcpu_run(vcpu);
        assert_ucall_vector(vcpu, DF_VECTOR);

        /*
         * Inject #SS, the #SS should bypass interception and cause #GP, which
         * L1 is no longer interception, and so should see a #DF VM-Exit.  L1
         * should then signal that is done.
         */
        queue_ss_exception(vcpu, true);
        vcpu_run(vcpu);
        assert_ucall_vector(vcpu, FAKE_TRIPLE_FAULT_VECTOR);

        /*
         * Inject #SS yet again.  L1 is not intercepting #GP or #DF, and so
         * should see nested TRIPLE_FAULT / SHUTDOWN.
         */
        queue_ss_exception(vcpu, true);
        vcpu_run(vcpu);
        assert_ucall_vector(vcpu, -1);

        kvm_vm_free(vm);
}