From: Mihai Donțu <[email protected]>

The KVMI_VCPU_INJECT_EXCEPTION command is used by the introspection tool
to inject exceptions, for example, to get a page from swap.

The exception is queued right before entering the guest unless there is
already an exception pending. The introspection tool is notified with
an KVMI_EVENT_TRAP event about the success of the injection.  In case
of failure, the introspecion tool is expected to try again later.

Signed-off-by: Mihai Donțu <[email protected]>
Co-developed-by: Nicușor Cîțu <[email protected]>
Signed-off-by: Nicușor Cîțu <[email protected]>
Co-developed-by: Adalbert Lazăr <[email protected]>
Signed-off-by: Adalbert Lazăr <[email protected]>
---
 Documentation/virt/kvm/kvmi.rst               |  74 ++++++++++++
 arch/x86/include/uapi/asm/kvmi.h              |  14 +++
 arch/x86/kvm/kvmi.c                           | 103 +++++++++++++++++
 arch/x86/kvm/x86.c                            |   3 +
 include/linux/kvmi_host.h                     |  12 ++
 include/uapi/linux/kvmi.h                     |  16 +--
 .../testing/selftests/kvm/x86_64/kvmi_test.c  | 109 +++++++++++++++++-
 virt/kvm/introspection/kvmi.c                 |  46 ++++++++
 virt/kvm/introspection/kvmi_int.h             |   8 ++
 virt/kvm/introspection/kvmi_msg.c             |  81 +++++++++----
 10 files changed, 433 insertions(+), 33 deletions(-)

diff --git a/Documentation/virt/kvm/kvmi.rst b/Documentation/virt/kvm/kvmi.rst
index c624ab59bd0e..d6a09fac4f52 100644
--- a/Documentation/virt/kvm/kvmi.rst
+++ b/Documentation/virt/kvm/kvmi.rst
@@ -557,6 +557,7 @@ The following vCPU events do not need to be enabled or 
disabled,
 because these are sent as a result of certain commands::
 
        KVMI_EVENT_PAUSE_VCPU
+       KVMI_EVENT_TRAP
 
 However, the events mentioned above can be disallowed.
 
@@ -715,6 +716,46 @@ ID set.
 * -KVM_EINVAL - the padding is not zero
 * -KVM_EAGAIN - the selected vCPU can't be introspected yet
 
+15. KVMI_VCPU_INJECT_EXCEPTION
+------------------------------
+
+:Architectures: x86
+:Versions: >= 1
+:Parameters:
+
+::
+
+       struct kvmi_vcpu_hdr;
+       struct kvmi_vcpu_inject_exception {
+               __u8 nr;
+               __u8 padding1;
+               __u16 padding2;
+               __u32 error_code;
+               __u64 address;
+       };
+
+:Returns:
+
+::
+
+       struct kvmi_error_code
+
+Injects a vCPU exception with or without an error code. In case of page fault
+exception, the guest virtual address has to be specified.
+
+The *KVMI_EVENT_TRAP* event will be sent with the effective injected expection.
+
+:Errors:
+
+* -KVM_EPERM  - the *KVMI_EVENT_TRAP* event is disallowed
+* -KVM_EINVAL - the selected vCPU is invalid
+* -KVM_EINVAL - the specified exception number is invalid
+* -KVM_EINVAL - the specified address is invalid
+* -KVM_EINVAL - the padding is not zero
+* -KVM_EAGAIN - the selected vCPU can't be introspected yet
+* -KVM_EBUSY - another *KVMI_VCPU_INJECT_EXCEPTION*-*KVMI_EVENT_TRAP* pair
+               is in progress
+
 Events
 ======
 
@@ -925,3 +966,36 @@ register (see **KVMI_VCPU_CONTROL_EVENTS**).
 
 ``kvmi_event``, the control register number, the old value and the new value
 are sent to the introspection tool. The *CONTINUE* action will set the 
``new_val``.
+
+6. KVMI_EVENT_TRAP
+------------------
+
+:Architectures: x86
+:Versions: >= 1
+:Actions: CONTINUE, CRASH
+:Parameters:
+
+::
+
+       struct kvmi_event;
+       struct kvmi_event_trap {
+               __u32 vector;
+               __u32 error_code;
+               __u64 cr2;
+       };
+
+:Returns:
+
+::
+
+       struct kvmi_vcpu_hdr;
+       struct kvmi_event_reply;
+
+This event is sent if a previous *KVMI_VCPU_INJECT_EXCEPTION* command
+took place. Because it has a high priority, it will be sent before any
+other vCPU introspection event.
+
+``kvmi_event``, exception/interrupt number (vector), exception code
+(``error_code``) and CR2 are sent to the introspection tool,
+which should check if its exception has been injected or overridden.
+
diff --git a/arch/x86/include/uapi/asm/kvmi.h b/arch/x86/include/uapi/asm/kvmi.h
index a3d29557cc15..073dbaac06b1 100644
--- a/arch/x86/include/uapi/asm/kvmi.h
+++ b/arch/x86/include/uapi/asm/kvmi.h
@@ -83,4 +83,18 @@ struct kvmi_event_cr_reply {
        __u64 new_val;
 };
 
+struct kvmi_event_trap {
+       __u32 vector;
+       __u32 error_code;
+       __u64 cr2;
+};
+
+struct kvmi_vcpu_inject_exception {
+       __u8 nr;
+       __u8 padding1;
+       __u16 padding2;
+       __u32 error_code;
+       __u64 address;
+};
+
 #endif /* _UAPI_ASM_X86_KVMI_H */
diff --git a/arch/x86/kvm/kvmi.c b/arch/x86/kvm/kvmi.c
index 281ebb47eaa2..9f8ef8a1a306 100644
--- a/arch/x86/kvm/kvmi.c
+++ b/arch/x86/kvm/kvmi.c
@@ -559,3 +559,106 @@ bool kvmi_cr3_intercepted(struct kvm_vcpu *vcpu)
        return ret;
 }
 EXPORT_SYMBOL(kvmi_cr3_intercepted);
+
+int kvmi_arch_cmd_vcpu_inject_exception(struct kvm_vcpu *vcpu, u8 vector,
+                                       u32 error_code, u64 address)
+{
+       struct kvm_vcpu_introspection *vcpui = VCPUI(vcpu);
+       bool has_error;
+
+       if (vcpui->exception.pending || vcpui->exception.send_event)
+               return -KVM_EBUSY;
+
+       vcpui->exception.pending = true;
+
+       has_error = x86_exception_has_error_code(vector);
+
+       vcpui->exception.nr = vector;
+       vcpui->exception.error_code = has_error ? error_code : 0;
+       vcpui->exception.error_code_valid = has_error;
+       vcpui->exception.address = address;
+
+       return 0;
+}
+
+static void kvmi_arch_queue_exception(struct kvm_vcpu *vcpu)
+{
+       struct kvm_vcpu_introspection *vcpui = VCPUI(vcpu);
+       struct x86_exception e = {
+               .vector = vcpui->exception.nr,
+               .error_code_valid = vcpui->exception.error_code_valid,
+               .error_code = vcpui->exception.error_code,
+               .address = vcpui->exception.address,
+       };
+
+       if (e.vector == PF_VECTOR)
+               kvm_inject_page_fault(vcpu, &e);
+       else if (e.error_code_valid)
+               kvm_queue_exception_e(vcpu, e.vector, e.error_code);
+       else
+               kvm_queue_exception(vcpu, e.vector);
+}
+
+static void kvmi_arch_save_injected_event(struct kvm_vcpu *vcpu)
+{
+       struct kvm_vcpu_introspection *vcpui = VCPUI(vcpu);
+
+       vcpui->exception.error_code = 0;
+       vcpui->exception.error_code_valid = false;
+
+       vcpui->exception.address = vcpu->arch.cr2;
+       if (vcpu->arch.exception.injected) {
+               vcpui->exception.nr = vcpu->arch.exception.nr;
+               vcpui->exception.error_code_valid =
+                       x86_exception_has_error_code(vcpu->arch.exception.nr);
+               vcpui->exception.error_code = vcpu->arch.exception.error_code;
+       } else if (vcpu->arch.interrupt.injected) {
+               vcpui->exception.nr = vcpu->arch.interrupt.nr;
+       }
+}
+
+void kvmi_arch_inject_exception(struct kvm_vcpu *vcpu)
+{
+       if (!kvm_event_needs_reinjection(vcpu)) {
+               kvmi_arch_queue_exception(vcpu);
+               kvm_inject_pending_exception(vcpu);
+       }
+
+       kvmi_arch_save_injected_event(vcpu);
+}
+
+static u32 kvmi_send_trap(struct kvm_vcpu *vcpu, u8 vector,
+                         u32 error_code, u64 cr2)
+{
+       struct kvmi_event_trap e;
+       int err, action;
+
+       memset(&e, 0, sizeof(e));
+       e.vector = vector;
+       e.error_code = error_code;
+       e.cr2 = cr2;
+
+       err = __kvmi_send_event(vcpu, KVMI_EVENT_TRAP, &e, sizeof(e),
+                               NULL, 0, &action);
+       if (err)
+               return KVMI_EVENT_ACTION_CONTINUE;
+
+       return action;
+}
+
+void kvmi_arch_trap_event(struct kvm_vcpu *vcpu)
+{
+       struct kvm_vcpu_introspection *vcpui = VCPUI(vcpu);
+       u32 action;
+
+       action = kvmi_send_trap(vcpu, vcpui->exception.nr,
+                               vcpui->exception.error_code,
+                               vcpui->exception.address);
+
+       switch (action) {
+       case KVMI_EVENT_ACTION_CONTINUE:
+               break;
+       default:
+               kvmi_handle_common_event_actions(vcpu->kvm, action, "TRAP");
+       }
+}
diff --git a/arch/x86/kvm/x86.c b/arch/x86/kvm/x86.c
index 5b88540384b4..0e3704bed6c4 100644
--- a/arch/x86/kvm/x86.c
+++ b/arch/x86/kvm/x86.c
@@ -8408,6 +8408,9 @@ static int vcpu_enter_guest(struct kvm_vcpu *vcpu)
                goto cancel_injection;
        }
 
+       if (!kvmi_enter_guest(vcpu))
+               req_immediate_exit = true;
+
        if (req_immediate_exit) {
                kvm_make_request(KVM_REQ_EVENT, vcpu);
                kvm_x86_ops->request_immediate_exit(vcpu);
diff --git a/include/linux/kvmi_host.h b/include/linux/kvmi_host.h
index 8f28065320d8..e64f2bbd033a 100644
--- a/include/linux/kvmi_host.h
+++ b/include/linux/kvmi_host.h
@@ -41,6 +41,15 @@ struct kvm_vcpu_introspection {
 
        struct kvm_regs delayed_regs;
        bool have_delayed_regs;
+
+       struct {
+               u8 nr;
+               u32 error_code;
+               bool error_code_valid;
+               u64 address;
+               bool pending;
+               bool send_event;
+       } exception;
 };
 
 struct kvm_introspection {
@@ -77,6 +86,7 @@ int kvmi_ioctl_preunhook(struct kvm *kvm);
 void kvmi_handle_requests(struct kvm_vcpu *vcpu);
 bool kvmi_hypercall_event(struct kvm_vcpu *vcpu);
 bool kvmi_breakpoint_event(struct kvm_vcpu *vcpu, u64 gva, u8 insn_len);
+bool kvmi_enter_guest(struct kvm_vcpu *vcpu);
 
 #else
 
@@ -91,6 +101,8 @@ static inline bool kvmi_hypercall_event(struct kvm_vcpu 
*vcpu) { return false; }
 static inline bool kvmi_breakpoint_event(struct kvm_vcpu *vcpu, u64 gva,
                                         u8 insn_len)
                        { return true; }
+static inline bool kvmi_enter_guest(struct kvm_vcpu *vcpu)
+                       { return true; }
 
 #endif /* CONFIG_KVM_INTROSPECTION */
 
diff --git a/include/uapi/linux/kvmi.h b/include/uapi/linux/kvmi.h
index 2826ac0f74e5..2603fa72154b 100644
--- a/include/uapi/linux/kvmi.h
+++ b/include/uapi/linux/kvmi.h
@@ -25,13 +25,14 @@ enum {
        KVMI_VM_READ_PHYSICAL    = 7,
        KVMI_VM_WRITE_PHYSICAL   = 8,
 
-       KVMI_VCPU_GET_INFO       = 9,
-       KVMI_VCPU_PAUSE          = 10,
-       KVMI_VCPU_CONTROL_EVENTS = 11,
-       KVMI_VCPU_GET_REGISTERS  = 12,
-       KVMI_VCPU_SET_REGISTERS  = 13,
-       KVMI_VCPU_GET_CPUID      = 14,
-       KVMI_VCPU_CONTROL_CR     = 15,
+       KVMI_VCPU_GET_INFO         = 9,
+       KVMI_VCPU_PAUSE            = 10,
+       KVMI_VCPU_CONTROL_EVENTS   = 11,
+       KVMI_VCPU_GET_REGISTERS    = 12,
+       KVMI_VCPU_SET_REGISTERS    = 13,
+       KVMI_VCPU_GET_CPUID        = 14,
+       KVMI_VCPU_CONTROL_CR       = 15,
+       KVMI_VCPU_INJECT_EXCEPTION = 16,
 
        KVMI_NUM_MESSAGES
 };
@@ -42,6 +43,7 @@ enum {
        KVMI_EVENT_HYPERCALL  = 2,
        KVMI_EVENT_BREAKPOINT = 3,
        KVMI_EVENT_CR         = 4,
+       KVMI_EVENT_TRAP       = 5,
 
        KVMI_NUM_EVENTS
 };
diff --git a/tools/testing/selftests/kvm/x86_64/kvmi_test.c 
b/tools/testing/selftests/kvm/x86_64/kvmi_test.c
index 9595e86cd79e..6a6ad736db36 100644
--- a/tools/testing/selftests/kvm/x86_64/kvmi_test.c
+++ b/tools/testing/selftests/kvm/x86_64/kvmi_test.c
@@ -45,6 +45,8 @@ struct vcpu_worker_data {
        int vcpu_id;
        int test_id;
        bool stop;
+       bool shutdown;
+       bool restart_on_shutdown;
 };
 
 enum {
@@ -603,11 +605,19 @@ static void *vcpu_worker(void *data)
 
                vcpu_run(ctx->vm, ctx->vcpu_id);
 
-               TEST_ASSERT(run->exit_reason == KVM_EXIT_IO,
+               TEST_ASSERT(run->exit_reason == KVM_EXIT_IO
+                       || (run->exit_reason == KVM_EXIT_SHUTDOWN
+                               && ctx->shutdown),
                        "vcpu_run() failed, test_id %d, exit reason %u (%s)\n",
                        ctx->test_id, run->exit_reason,
                        exit_reason_str(run->exit_reason));
 
+               if (run->exit_reason == KVM_EXIT_SHUTDOWN) {
+                       if (ctx->restart_on_shutdown)
+                               continue;
+                       break;
+               }
+
                TEST_ASSERT(get_ucall(ctx->vm, ctx->vcpu_id, &uc),
                        "No guest request\n");
 
@@ -1126,6 +1136,102 @@ static void test_cmd_vcpu_control_cr(struct kvm_vm *vm)
                sregs.cr4, ev.cr.old_value);
 }
 
+static void __inject_exception(struct kvm_vm *vm, int vector)
+{
+       struct {
+               struct kvmi_msg_hdr hdr;
+               struct kvmi_vcpu_hdr vcpu_hdr;
+               struct kvmi_vcpu_inject_exception cmd;
+       } req = {};
+       __u16 vcpu_index = 0;
+       int r;
+
+       req.vcpu_hdr.vcpu = vcpu_index;
+       req.cmd.nr = vector;
+
+       r = do_command(KVMI_VCPU_INJECT_EXCEPTION,
+                       &req.hdr, sizeof(req), NULL, 0);
+       TEST_ASSERT(r == 0,
+               "KVMI_VCPU_INJECT_EXCEPTION failed, error %d(%s)\n",
+               -r, kvm_strerror(-r));
+}
+
+static void receive_exception_event(struct kvm_vm *vm, int vector)
+{
+       struct kvmi_msg_hdr hdr;
+       struct {
+               struct kvmi_event common;
+               struct kvmi_event_trap trap;
+       } ev;
+       struct vcpu_reply rpl = {};
+
+       receive_event(&hdr, &ev.common, sizeof(ev), KVMI_EVENT_TRAP);
+
+       DEBUG("Exception event: vector %u, error_code 0x%x, cr2 0x%llx\n",
+               ev.trap.vector, ev.trap.error_code, ev.trap.cr2);
+
+       TEST_ASSERT(ev.trap.vector == vector,
+               "Injected exception %u instead of %u\n",
+               ev.trap.vector, vector);
+
+       reply_to_event(&hdr, &ev.common, KVMI_EVENT_ACTION_CONTINUE,
+                       &rpl, sizeof(rpl));
+}
+
+static void test_cmd_vcpu_inject_exception(struct kvm_vm *vm)
+{
+       struct vcpu_worker_data data = {
+               .vm = vm,
+               .vcpu_id = VCPU_ID,
+               .shutdown = true,
+               .restart_on_shutdown = true,
+       };
+       struct kvmi_msg_hdr hdr;
+       struct {
+               struct kvmi_event common;
+               struct kvmi_event_breakpoint bp;
+       } ev;
+       struct vcpu_reply rpl = {};
+       pthread_t vcpu_thread;
+       __u8 ud_vector = 6;
+       __u8 bp_vector = 3;
+
+       if (!is_intel_cpu()) {
+               DEBUG("TODO: %s() - make it work with AMD\n", __func__);
+               return;
+       }
+
+       enable_vcpu_event(vm, KVMI_EVENT_BREAKPOINT);
+
+       vcpu_thread = start_vcpu_worker(&data);
+
+       __inject_exception(vm, ud_vector);
+
+       /* confirm that our exception has been injected */
+       receive_exception_event(vm, ud_vector);
+
+       WRITE_ONCE(data.test_id, GUEST_TEST_BP);
+
+       receive_event(&hdr, &ev.common, sizeof(ev), KVMI_EVENT_BREAKPOINT);
+
+       __inject_exception(vm, ud_vector);
+
+       /* skip the breakpoint instruction, next time guest_bp_test() runs */
+       ev.common.arch.regs.rip += ev.bp.insn_len;
+       __set_registers(vm, &ev.common.arch.regs);
+
+       /* reinject the #BP exception */
+       reply_to_event(&hdr, &ev.common, KVMI_EVENT_ACTION_CONTINUE,
+                       &rpl, sizeof(rpl));
+
+       /* confirm that our injection didn't override the #BP exception */
+       receive_exception_event(vm, bp_vector);
+
+       stop_vcpu_worker(vcpu_thread, &data);
+
+       disable_vcpu_event(vm, KVMI_EVENT_BREAKPOINT);
+}
+
 static void test_introspection(struct kvm_vm *vm)
 {
        srandom(time(0));
@@ -1149,6 +1255,7 @@ static void test_introspection(struct kvm_vm *vm)
        test_event_hypercall(vm);
        test_event_breakpoint(vm);
        test_cmd_vcpu_control_cr(vm);
+       test_cmd_vcpu_inject_exception(vm);
 
        unhook_introspection(vm);
 }
diff --git a/virt/kvm/introspection/kvmi.c b/virt/kvm/introspection/kvmi.c
index 6d421cf213d7..0f2cec7e9c90 100644
--- a/virt/kvm/introspection/kvmi.c
+++ b/virt/kvm/introspection/kvmi.c
@@ -82,6 +82,7 @@ static void setup_known_events(void)
        set_bit(KVMI_EVENT_CR, Kvmi_known_vcpu_events);
        set_bit(KVMI_EVENT_HYPERCALL, Kvmi_known_vcpu_events);
        set_bit(KVMI_EVENT_PAUSE_VCPU, Kvmi_known_vcpu_events);
+       set_bit(KVMI_EVENT_TRAP, Kvmi_known_vcpu_events);
 
        bitmap_or(Kvmi_known_events, Kvmi_known_vm_events,
                  Kvmi_known_vcpu_events, KVMI_NUM_EVENTS);
@@ -803,6 +804,16 @@ static void kvmi_vcpu_pause_event(struct kvm_vcpu *vcpu)
        }
 }
 
+void kvmi_send_pending_event(struct kvm_vcpu *vcpu)
+{
+       struct kvm_vcpu_introspection *vcpui = VCPUI(vcpu);
+
+       if (vcpui->exception.send_event) {
+               kvmi_arch_trap_event(vcpu);
+               vcpui->exception.send_event = false;
+       }
+}
+
 void kvmi_handle_requests(struct kvm_vcpu *vcpu)
 {
        struct kvm_vcpu_introspection *vcpui = VCPUI(vcpu);
@@ -812,6 +823,8 @@ void kvmi_handle_requests(struct kvm_vcpu *vcpu)
        if (!kvmi)
                goto out;
 
+       kvmi_send_pending_event(vcpu);
+
        for (;;) {
                kvmi_run_jobs(vcpu);
 
@@ -910,3 +923,36 @@ bool kvmi_breakpoint_event(struct kvm_vcpu *vcpu, u64 gva, 
u8 insn_len)
        return ret;
 }
 EXPORT_SYMBOL(kvmi_breakpoint_event);
+
+static bool kvmi_inject_pending_exception(struct kvm_vcpu *vcpu)
+{
+       struct kvm_vcpu_introspection *vcpui = VCPUI(vcpu);
+
+       if (!vcpui->exception.pending)
+               return false;
+
+       kvmi_arch_inject_exception(vcpu);
+
+       vcpui->exception.send_event = true;
+       kvm_make_request(KVM_REQ_INTROSPECTION, vcpu);
+
+       vcpui->exception.pending = false;
+
+       return true;
+}
+
+bool kvmi_enter_guest(struct kvm_vcpu *vcpu)
+{
+       struct kvm_introspection *kvmi;
+       bool r = true;
+
+       kvmi = kvmi_get(vcpu->kvm);
+       if (!kvmi)
+               return true;
+
+       if (kvmi_inject_pending_exception(vcpu))
+               r = false;
+
+       kvmi_put(vcpu->kvm);
+       return r;
+}
diff --git a/virt/kvm/introspection/kvmi_int.h 
b/virt/kvm/introspection/kvmi_int.h
index 588a386a3f37..59a8b20af0fd 100644
--- a/virt/kvm/introspection/kvmi_int.h
+++ b/virt/kvm/introspection/kvmi_int.h
@@ -36,6 +36,9 @@ bool kvmi_msg_process(struct kvm_introspection *kvmi);
 int kvmi_send_event(struct kvm_vcpu *vcpu, u32 ev_id,
                    void *ev, size_t ev_size,
                    void *rpl, size_t rpl_size, int *action);
+int __kvmi_send_event(struct kvm_vcpu *vcpu, u32 ev_id,
+                     void *ev, size_t ev_size,
+                     void *rpl, size_t rpl_size, int *action);
 int kvmi_msg_send_unhook(struct kvm_introspection *kvmi);
 u32 kvmi_msg_send_vcpu_pause(struct kvm_vcpu *vcpu);
 u32 kvmi_msg_send_hypercall(struct kvm_vcpu *vcpu);
@@ -54,6 +57,7 @@ void kvmi_handle_common_event_actions(struct kvm *kvm,
                                      u32 action, const char *str);
 struct kvm_introspection * __must_check kvmi_get(struct kvm *kvm);
 void kvmi_put(struct kvm *kvm);
+void kvmi_send_pending_event(struct kvm_vcpu *vcpu);
 int kvmi_cmd_vm_control_events(struct kvm_introspection *kvmi,
                                unsigned int event_id, bool enable);
 int kvmi_cmd_vcpu_control_events(struct kvm_vcpu *vcpu,
@@ -95,5 +99,9 @@ int kvmi_arch_cmd_control_intercept(struct kvm_vcpu *vcpu,
                                    unsigned int event_id, bool enable);
 int kvmi_arch_cmd_vcpu_control_cr(struct kvm_vcpu *vcpu,
                                  const struct kvmi_vcpu_control_cr *req);
+int kvmi_arch_cmd_vcpu_inject_exception(struct kvm_vcpu *vcpu, u8 vector,
+                                       u32 error_code, u64 address);
+void kvmi_arch_trap_event(struct kvm_vcpu *vcpu);
+void kvmi_arch_inject_exception(struct kvm_vcpu *vcpu);
 
 #endif
diff --git a/virt/kvm/introspection/kvmi_msg.c 
b/virt/kvm/introspection/kvmi_msg.c
index 789aa9f1912f..830430777556 100644
--- a/virt/kvm/introspection/kvmi_msg.c
+++ b/virt/kvm/introspection/kvmi_msg.c
@@ -20,21 +20,22 @@ struct kvmi_vcpu_cmd_job {
 };
 
 static const char *const msg_IDs[] = {
-       [KVMI_EVENT]               = "KVMI_EVENT",
-       [KVMI_GET_VERSION]         = "KVMI_GET_VERSION",
-       [KVMI_VM_CHECK_COMMAND]    = "KVMI_VM_CHECK_COMMAND",
-       [KVMI_VM_CHECK_EVENT]      = "KVMI_VM_CHECK_EVENT",
-       [KVMI_VM_CONTROL_EVENTS]   = "KVMI_VM_CONTROL_EVENTS",
-       [KVMI_VM_GET_INFO]         = "KVMI_VM_GET_INFO",
-       [KVMI_VM_READ_PHYSICAL]    = "KVMI_VM_READ_PHYSICAL",
-       [KVMI_VM_WRITE_PHYSICAL]   = "KVMI_VM_WRITE_PHYSICAL",
-       [KVMI_VCPU_CONTROL_CR]     = "KVMI_VCPU_CONTROL_CR",
-       [KVMI_VCPU_CONTROL_EVENTS] = "KVMI_VCPU_CONTROL_EVENTS",
-       [KVMI_VCPU_GET_CPUID]      = "KVMI_VCPU_GET_CPUID",
-       [KVMI_VCPU_GET_INFO]       = "KVMI_VCPU_GET_INFO",
-       [KVMI_VCPU_GET_REGISTERS]  = "KVMI_VCPU_GET_REGISTERS",
-       [KVMI_VCPU_PAUSE]          = "KVMI_VCPU_PAUSE",
-       [KVMI_VCPU_SET_REGISTERS]  = "KVMI_VCPU_SET_REGISTERS",
+       [KVMI_EVENT]                 = "KVMI_EVENT",
+       [KVMI_GET_VERSION]           = "KVMI_GET_VERSION",
+       [KVMI_VM_CHECK_COMMAND]      = "KVMI_VM_CHECK_COMMAND",
+       [KVMI_VM_CHECK_EVENT]        = "KVMI_VM_CHECK_EVENT",
+       [KVMI_VM_CONTROL_EVENTS]     = "KVMI_VM_CONTROL_EVENTS",
+       [KVMI_VM_GET_INFO]           = "KVMI_VM_GET_INFO",
+       [KVMI_VM_READ_PHYSICAL]      = "KVMI_VM_READ_PHYSICAL",
+       [KVMI_VM_WRITE_PHYSICAL]     = "KVMI_VM_WRITE_PHYSICAL",
+       [KVMI_VCPU_CONTROL_CR]       = "KVMI_VCPU_CONTROL_CR",
+       [KVMI_VCPU_CONTROL_EVENTS]   = "KVMI_VCPU_CONTROL_EVENTS",
+       [KVMI_VCPU_GET_CPUID]        = "KVMI_VCPU_GET_CPUID",
+       [KVMI_VCPU_GET_INFO]         = "KVMI_VCPU_GET_INFO",
+       [KVMI_VCPU_GET_REGISTERS]    = "KVMI_VCPU_GET_REGISTERS",
+       [KVMI_VCPU_INJECT_EXCEPTION] = "KVMI_VCPU_INJECT_EXCEPTION",
+       [KVMI_VCPU_PAUSE]            = "KVMI_VCPU_PAUSE",
+       [KVMI_VCPU_SET_REGISTERS]    = "KVMI_VCPU_SET_REGISTERS",
 };
 
 static const char *id2str(u16 id)
@@ -526,6 +527,25 @@ static int handle_vcpu_control_cr(const struct 
kvmi_vcpu_cmd_job *job,
        return kvmi_msg_vcpu_reply(job, msg, ec, NULL, 0);
 }
 
+static int handle_vcpu_inject_exception(const struct kvmi_vcpu_cmd_job *job,
+                                       const struct kvmi_msg_hdr *msg,
+                                       const void *_req)
+{
+       const struct kvmi_vcpu_inject_exception *req = _req;
+       int ec;
+
+       if (!is_event_allowed(KVMI(job->vcpu->kvm), KVMI_EVENT_TRAP))
+               ec = -KVM_EPERM;
+       else if (req->padding1 || req->padding2)
+               ec = -KVM_EINVAL;
+       else
+               ec = kvmi_arch_cmd_vcpu_inject_exception(job->vcpu, req->nr,
+                                                        req->error_code,
+                                                        req->address);
+
+       return kvmi_msg_vcpu_reply(job, msg, ec, NULL, 0);
+}
+
 /*
  * These commands are executed from the vCPU thread. The receiving thread
  * passes the messages using a newly allocated 'struct kvmi_vcpu_cmd_job'
@@ -534,13 +554,14 @@ static int handle_vcpu_control_cr(const struct 
kvmi_vcpu_cmd_job *job,
  */
 static int(*const msg_vcpu[])(const struct kvmi_vcpu_cmd_job *,
                              const struct kvmi_msg_hdr *, const void *) = {
-       [KVMI_EVENT]               = handle_event_reply,
-       [KVMI_VCPU_CONTROL_CR]     = handle_vcpu_control_cr,
-       [KVMI_VCPU_CONTROL_EVENTS] = handle_vcpu_control_events,
-       [KVMI_VCPU_GET_CPUID]      = handle_get_cpuid,
-       [KVMI_VCPU_GET_INFO]       = handle_get_vcpu_info,
-       [KVMI_VCPU_GET_REGISTERS]  = handle_get_registers,
-       [KVMI_VCPU_SET_REGISTERS]  = handle_set_registers,
+       [KVMI_EVENT]                 = handle_event_reply,
+       [KVMI_VCPU_CONTROL_CR]       = handle_vcpu_control_cr,
+       [KVMI_VCPU_CONTROL_EVENTS]   = handle_vcpu_control_events,
+       [KVMI_VCPU_GET_CPUID]        = handle_get_cpuid,
+       [KVMI_VCPU_GET_INFO]         = handle_get_vcpu_info,
+       [KVMI_VCPU_GET_REGISTERS]    = handle_get_registers,
+       [KVMI_VCPU_INJECT_EXCEPTION] = handle_vcpu_inject_exception,
+       [KVMI_VCPU_SET_REGISTERS]    = handle_set_registers,
 };
 
 static bool is_vcpu_command(u16 id)
@@ -797,9 +818,9 @@ static void kvmi_setup_vcpu_reply(struct 
kvm_vcpu_introspection *vcpui,
        vcpui->waiting_for_reply = true;
 }
 
-int kvmi_send_event(struct kvm_vcpu *vcpu, u32 ev_id,
-                   void *ev, size_t ev_size,
-                   void *rpl, size_t rpl_size, int *action)
+int __kvmi_send_event(struct kvm_vcpu *vcpu, u32 ev_id,
+                     void *ev, size_t ev_size,
+                     void *rpl, size_t rpl_size, int *action)
 {
        struct kvmi_msg_hdr hdr;
        struct kvmi_event common;
@@ -839,6 +860,16 @@ int kvmi_send_event(struct kvm_vcpu *vcpu, u32 ev_id,
        return err;
 }
 
+int kvmi_send_event(struct kvm_vcpu *vcpu, u32 ev_id,
+                   void *ev, size_t ev_size,
+                   void *rpl, size_t rpl_size, int *action)
+{
+       kvmi_send_pending_event(vcpu);
+
+       return __kvmi_send_event(vcpu, ev_id, ev, ev_size,
+                                rpl, rpl_size, action);
+}
+
 u32 kvmi_msg_send_vcpu_pause(struct kvm_vcpu *vcpu)
 {
        int err, action;
_______________________________________________
Virtualization mailing list
[email protected]
https://lists.linuxfoundation.org/mailman/listinfo/virtualization

Reply via email to