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

These commands allows the introspection tool to read/write from/to the
guest memory.

Signed-off-by: Mihai Donțu <[email protected]>
Co-developed-by: Adalbert Lazăr <[email protected]>
Signed-off-by: Adalbert Lazăr <[email protected]>
---
 Documentation/virt/kvm/kvmi.rst               |  62 +++++++
 include/uapi/linux/kvmi.h                     |  13 ++
 .../testing/selftests/kvm/x86_64/kvmi_test.c  | 167 ++++++++++++++++++
 virt/kvm/introspection/kvmi.c                 | 135 ++++++++++++++
 virt/kvm/introspection/kvmi_int.h             |   9 +
 virt/kvm/introspection/kvmi_msg.c             |  46 +++++
 6 files changed, 432 insertions(+)

diff --git a/Documentation/virt/kvm/kvmi.rst b/Documentation/virt/kvm/kvmi.rst
index 7039f4d2b782..60fa50585c36 100644
--- a/Documentation/virt/kvm/kvmi.rst
+++ b/Documentation/virt/kvm/kvmi.rst
@@ -366,6 +366,68 @@ the following events::
 * -KVM_EINVAL - padding is not zero
 * -KVM_EPERM - the access is restricted by the host
 
+6. KVMI_VM_READ_PHYSICAL
+------------------------
+
+:Architectures: all
+:Versions: >= 1
+:Parameters:
+
+::
+
+       struct kvmi_vm_read_physical {
+               __u64 gpa;
+               __u64 size;
+       };
+
+:Returns:
+
+::
+
+       struct kvmi_error_code;
+       __u8 data[0];
+
+Reads from the guest memory.
+
+Currently, the size must be non-zero and the read must be restricted to
+one page (offset + size <= PAGE_SIZE).
+
+:Errors:
+
+* -KVM_EINVAL - the specified gpa/size pair is invalid
+* -KVM_ENOENT - the guest page doesn't exists
+
+7. KVMI_VM_WRITE_PHYSICAL
+-------------------------
+
+:Architectures: all
+:Versions: >= 1
+:Parameters:
+
+::
+
+       struct kvmi_vm_write_physical {
+               __u64 gpa;
+               __u64 size;
+               __u8  data[0];
+       };
+
+:Returns:
+
+::
+
+       struct kvmi_error_code
+
+Writes into the guest memory.
+
+Currently, the size must be non-zero and the write must be restricted to
+one page (offset + size <= PAGE_SIZE).
+
+:Errors:
+
+* -KVM_EINVAL - the specified gpa/size pair is invalid
+* -KVM_ENOENT - the guest page doesn't exists
+
 Events
 ======
 
diff --git a/include/uapi/linux/kvmi.h b/include/uapi/linux/kvmi.h
index da9bf30ae513..3b8590c0fc98 100644
--- a/include/uapi/linux/kvmi.h
+++ b/include/uapi/linux/kvmi.h
@@ -22,6 +22,8 @@ enum {
        KVMI_VM_CHECK_EVENT    = 4,
        KVMI_VM_GET_INFO       = 5,
        KVMI_VM_CONTROL_EVENTS = 6,
+       KVMI_VM_READ_PHYSICAL  = 7,
+       KVMI_VM_WRITE_PHYSICAL = 8,
 
        KVMI_NUM_MESSAGES
 };
@@ -76,6 +78,17 @@ struct kvmi_vm_control_events {
        __u32 padding2;
 };
 
+struct kvmi_vm_read_physical {
+       __u64 gpa;
+       __u64 size;
+};
+
+struct kvmi_vm_write_physical {
+       __u64 gpa;
+       __u64 size;
+       __u8  data[0];
+};
+
 struct kvmi_event {
        __u16 size;
        __u16 vcpu;
diff --git a/tools/testing/selftests/kvm/x86_64/kvmi_test.c 
b/tools/testing/selftests/kvm/x86_64/kvmi_test.c
index 23dba71e7dc6..b0573d7e2e5b 100644
--- a/tools/testing/selftests/kvm/x86_64/kvmi_test.c
+++ b/tools/testing/selftests/kvm/x86_64/kvmi_test.c
@@ -24,6 +24,13 @@ static int socket_pair[2];
 #define Kvm_socket       socket_pair[0]
 #define Userspace_socket socket_pair[1]
 
+static vm_vaddr_t test_gva;
+static void *test_hva;
+static vm_paddr_t test_gpa;
+
+static uint8_t test_write_pattern;
+static int page_size;
+
 void setup_socket(void)
 {
        int r;
@@ -356,6 +363,150 @@ static void test_cmd_vm_control_events(void)
        disable_vm_event(id);
 }
 
+static int cmd_write_page(__u64 gpa, __u64 size, void *p)
+{
+       struct kvmi_vm_write_physical *cmd;
+       struct kvmi_msg_hdr *req;
+       size_t req_size;
+       int r;
+
+       req_size = sizeof(*req) + sizeof(*cmd) + size;
+
+       req = calloc(1, req_size);
+       TEST_ASSERT(req, "Insufficient Memory\n");
+
+       cmd = (struct kvmi_vm_write_physical *)(req + 1);
+       cmd->gpa = gpa;
+       cmd->size = size;
+
+       memcpy(cmd + 1, p, size);
+
+       r = do_command(KVMI_VM_WRITE_PHYSICAL, req, req_size, NULL, 0);
+
+       free(req);
+
+       return r;
+}
+
+static void write_guest_page(__u64 gpa, void *p)
+{
+       int r;
+
+       r = cmd_write_page(gpa, page_size, p);
+       TEST_ASSERT(r == 0,
+               "KVMI_VM_WRITE_PHYSICAL failed, gpa 0x%lx, error %d (%s)\n",
+               gpa, -r, kvm_strerror(-r));
+}
+
+static void write_with_invalid_arguments(__u64 gpa, __u64 size, void *p)
+{
+       int r;
+
+       r = cmd_write_page(gpa, size, p);
+       TEST_ASSERT(r == -KVM_EINVAL,
+               "KVMI_VM_WRITE_PHYSICAL did not failed with EINVAL, gpa 0x%lx, 
error %d (%s)\n",
+               gpa, -r, kvm_strerror(-r));
+}
+
+static void write_invalid_guest_page(struct kvm_vm *vm, void *p)
+{
+       uint64_t gpa = vm->max_gfn << vm->page_shift;
+       int r;
+
+       r = cmd_write_page(gpa, 1, p);
+       TEST_ASSERT(r == -KVM_ENOENT,
+               "KVMI_VM_WRITE_PHYSICAL did not failed with ENOENT, gpa 0x%lx, 
error %d (%s)\n",
+               gpa, -r, kvm_strerror(-r));
+}
+
+static int cmd_read_page(__u64 gpa, __u64 size, void *p)
+{
+       struct {
+               struct kvmi_msg_hdr hdr;
+               struct kvmi_vm_read_physical cmd;
+       } req = { };
+
+       req.cmd.gpa = gpa;
+       req.cmd.size = size;
+
+       return do_command(KVMI_VM_READ_PHYSICAL, &req.hdr, sizeof(req), p,
+                            page_size);
+}
+
+static void read_guest_page(__u64 gpa, void *p)
+{
+       int r;
+
+       r = cmd_read_page(gpa, page_size, p);
+       TEST_ASSERT(r == 0,
+               "KVMI_VM_READ_PHYSICAL failed, gpa 0x%lx, error %d (%s)\n",
+               gpa, -r, kvm_strerror(-r));
+}
+
+static void read_with_invalid_arguments(__u64 gpa, __u64 size, void *p)
+{
+       int r;
+
+       r = cmd_read_page(gpa, size, p);
+       TEST_ASSERT(r == -KVM_EINVAL,
+               "KVMI_VM_READ_PHYSICAL did not failed with EINVAL, gpa 0x%lx, 
error %d (%s)\n",
+               gpa, -r, kvm_strerror(-r));
+}
+
+static void read_invalid_guest_page(struct kvm_vm *vm)
+{
+       uint64_t gpa = vm->max_gfn << vm->page_shift;
+       int r;
+
+       r = cmd_read_page(gpa, 1, NULL);
+       TEST_ASSERT(r == -KVM_ENOENT,
+               "KVMI_VM_READ_PHYSICAL did not failed with ENOENT, gpa 0x%lx, 
error %d (%s)\n",
+               gpa, -r, kvm_strerror(-r));
+}
+
+static void new_test_write_pattern(struct kvm_vm *vm)
+{
+       uint8_t n;
+
+       do {
+               n = random();
+       } while (!n || n == test_write_pattern);
+
+       test_write_pattern = n;
+       sync_global_to_guest(vm, test_write_pattern);
+}
+
+static void test_memory_access(struct kvm_vm *vm)
+{
+       void *pw, *pr;
+
+       new_test_write_pattern(vm);
+
+       pw = malloc(page_size);
+       TEST_ASSERT(pw, "Insufficient Memory\n");
+
+       memset(pw, test_write_pattern, page_size);
+
+       write_guest_page(test_gpa, pw);
+       TEST_ASSERT(memcmp(pw, test_hva, page_size) == 0,
+               "Write page test failed");
+
+       pr = malloc(page_size);
+       TEST_ASSERT(pr, "Insufficient Memory\n");
+
+       read_guest_page(test_gpa, pr);
+       TEST_ASSERT(memcmp(pw, pr, page_size) == 0,
+               "Read page test failed");
+
+       read_with_invalid_arguments(test_gpa, 0, pr);
+       write_with_invalid_arguments(test_gpa, 0, pw);
+       write_invalid_guest_page(vm, pw);
+
+       free(pw);
+       free(pr);
+
+       read_invalid_guest_page(vm);
+}
 static void test_introspection(struct kvm_vm *vm)
 {
        setup_socket();
@@ -368,10 +519,23 @@ static void test_introspection(struct kvm_vm *vm)
        test_cmd_get_vm_info();
        test_event_unhook(vm);
        test_cmd_vm_control_events();
+       test_memory_access(vm);
 
        unhook_introspection(vm);
 }
 
+static void setup_test_pages(struct kvm_vm *vm)
+{
+       test_gva = vm_vaddr_alloc(vm, page_size, KVM_UTIL_MIN_VADDR, 0, 0);
+
+       sync_global_to_guest(vm, test_gva);
+
+       test_hva = addr_gva2hva(vm, test_gva);
+       memset(test_hva, 0, page_size);
+
+       test_gpa = addr_gva2gpa(vm, test_gva);
+}
+
 int main(int argc, char *argv[])
 {
        struct kvm_vm *vm;
@@ -385,6 +549,9 @@ int main(int argc, char *argv[])
        vm = vm_create_default(VCPU_ID, 0, NULL);
        vcpu_set_cpuid(vm, VCPU_ID, kvm_get_supported_cpuid());
 
+       page_size = getpagesize();
+       setup_test_pages(vm);
+
        test_introspection(vm);
 
        return 0;
diff --git a/virt/kvm/introspection/kvmi.c b/virt/kvm/introspection/kvmi.c
index 9d246152c5e8..9e4e8fb07859 100644
--- a/virt/kvm/introspection/kvmi.c
+++ b/virt/kvm/introspection/kvmi.c
@@ -5,6 +5,7 @@
  * Copyright (C) 2017-2020 Bitdefender S.R.L.
  *
  */
+#include <linux/mmu_context.h>
 #include "kvmi_int.h"
 #include <linux/kthread.h>
 
@@ -368,3 +369,137 @@ int kvmi_cmd_vm_control_events(struct kvm_introspection 
*kvmi,
 
        return 0;
 }
+
+unsigned long gfn_to_hva_safe(struct kvm *kvm, gfn_t gfn)
+{
+       unsigned long hva;
+       int srcu_idx;
+
+       srcu_idx = srcu_read_lock(&kvm->srcu);
+       hva = gfn_to_hva(kvm, gfn);
+       srcu_read_unlock(&kvm->srcu, srcu_idx);
+
+       return hva;
+}
+
+static long
+get_user_pages_remote_unlocked(struct mm_struct *mm, unsigned long start,
+                               unsigned long nr_pages, unsigned int gup_flags,
+                               struct page **pages)
+{
+       struct vm_area_struct **vmas = NULL;
+       struct task_struct *tsk = NULL;
+       int locked = 1;
+       long r;
+
+       down_read(&mm->mmap_sem);
+       r = get_user_pages_remote(tsk, mm, start, nr_pages, gup_flags,
+                                 pages, vmas, &locked);
+       if (locked)
+               up_read(&mm->mmap_sem);
+
+       return r;
+}
+
+static void *get_page_ptr(struct kvm *kvm, gpa_t gpa, struct page **page,
+                         bool write)
+{
+       unsigned int flags = write ? FOLL_WRITE : 0;
+       unsigned long hva;
+
+       *page = NULL;
+
+       hva = gfn_to_hva_safe(kvm, gpa_to_gfn(gpa));
+
+       if (kvm_is_error_hva(hva))
+               return NULL;
+
+       if (get_user_pages_remote_unlocked(kvm->mm, hva, 1, flags, page) != 1)
+               return NULL;
+
+       return write ? kmap_atomic(*page) : kmap(*page);
+}
+
+static void put_page_ptr(void *ptr, struct page *page, bool write)
+{
+       if (ptr) {
+               if (write)
+                       kunmap_atomic(ptr);
+               else
+                       kunmap(ptr);
+       }
+       if (page)
+               put_page(page);
+}
+
+static int get_first_vcpu(struct kvm *kvm, struct kvm_vcpu **vcpu)
+{
+       struct kvm_vcpu *v;
+
+       if (!atomic_read(&kvm->online_vcpus))
+               return -KVM_EINVAL;
+
+       v = kvm_get_vcpu(kvm, 0);
+       if (!v)
+               return -KVM_EINVAL;
+
+       *vcpu = v;
+
+       return 0;
+}
+
+int kvmi_cmd_read_physical(struct kvm *kvm, u64 gpa, u64 size,
+                          int (*send)(struct kvm_introspection *,
+                                       const struct kvmi_msg_hdr *,
+                                       int err, const void *buf, size_t),
+                          const struct kvmi_msg_hdr *ctx)
+{
+       void *ptr_page = NULL, *ptr = NULL;
+       struct page *page = NULL;
+       struct kvm_vcpu *vcpu;
+       size_t ptr_size = 0;
+       int err, ec;
+
+       ec = get_first_vcpu(kvm, &vcpu);
+
+       if (ec)
+               goto out;
+
+       ptr_page = get_page_ptr(kvm, gpa, &page, false);
+       if (!ptr_page) {
+               ec = -KVM_ENOENT;
+               goto out;
+       }
+
+       ptr = ptr_page + (gpa & ~PAGE_MASK);
+       ptr_size = size;
+
+out:
+       err = send(KVMI(kvm), ctx, ec, ptr, ptr_size);
+
+       put_page_ptr(ptr_page, page, false);
+       return err;
+}
+
+int kvmi_cmd_write_physical(struct kvm *kvm, u64 gpa, u64 size, const void 
*buf)
+{
+       struct kvm_vcpu *vcpu;
+       struct page *page;
+       void *ptr;
+       int err;
+
+       err = get_first_vcpu(kvm, &vcpu);
+
+       if (err)
+               return err;
+
+       ptr = get_page_ptr(kvm, gpa, &page, true);
+       if (!ptr)
+               return -KVM_ENOENT;
+
+       memcpy(ptr + (gpa & ~PAGE_MASK), buf, size);
+
+       put_page_ptr(ptr, page, true);
+
+       return 0;
+}
diff --git a/virt/kvm/introspection/kvmi_int.h 
b/virt/kvm/introspection/kvmi_int.h
index d1c143334626..3bc598b9b66c 100644
--- a/virt/kvm/introspection/kvmi_int.h
+++ b/virt/kvm/introspection/kvmi_int.h
@@ -31,6 +31,8 @@
                        | BIT(KVMI_VM_CHECK_EVENT) \
                        | BIT(KVMI_VM_CONTROL_EVENTS) \
                        | BIT(KVMI_VM_GET_INFO) \
+                       | BIT(KVMI_VM_READ_PHYSICAL) \
+                       | BIT(KVMI_VM_WRITE_PHYSICAL) \
                )
 
 #define KVMI(kvm) ((struct kvm_introspection *)((kvm)->kvmi))
@@ -54,5 +56,12 @@ void *kvmi_msg_alloc_check(size_t size);
 void kvmi_msg_free(void *addr);
 int kvmi_cmd_vm_control_events(struct kvm_introspection *kvmi,
                                unsigned int event_id, bool enable);
+int kvmi_cmd_read_physical(struct kvm *kvm, u64 gpa, u64 size,
+                          int (*send)(struct kvm_introspection *,
+                                       const struct kvmi_msg_hdr*,
+                                       int err, const void *buf, size_t),
+                          const struct kvmi_msg_hdr *ctx);
+int kvmi_cmd_write_physical(struct kvm *kvm, u64 gpa, u64 size,
+                           const void *buf);
 
 #endif
diff --git a/virt/kvm/introspection/kvmi_msg.c 
b/virt/kvm/introspection/kvmi_msg.c
index 79b26853b5cb..032b6b5b8000 100644
--- a/virt/kvm/introspection/kvmi_msg.c
+++ b/virt/kvm/introspection/kvmi_msg.c
@@ -14,6 +14,8 @@ static const char *const msg_IDs[] = {
        [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",
 };
 
 static bool is_known_message(u16 id)
@@ -207,6 +209,48 @@ static int handle_vm_control_events(struct 
kvm_introspection *kvmi,
        return kvmi_msg_vm_reply(kvmi, msg, ec, NULL, 0);
 }
 
+static bool invalid_page_access(u64 gpa, u64 size)
+{
+       u64 off = gpa & ~PAGE_MASK;
+
+       return (size == 0 || size > PAGE_SIZE || off + size > PAGE_SIZE);
+}
+
+static int handle_read_physical(struct kvm_introspection *kvmi,
+                               const struct kvmi_msg_hdr *msg,
+                               const void *_req)
+{
+       const struct kvmi_vm_read_physical *req = _req;
+
+       if (invalid_page_access(req->gpa, req->size)) {
+               int ec = -KVM_EINVAL;
+
+               return kvmi_msg_vm_reply(kvmi, msg, ec, NULL, 0);
+       }
+
+       return kvmi_cmd_read_physical(kvmi->kvm, req->gpa, req->size,
+                                     kvmi_msg_vm_reply, msg);
+}
+
+static int handle_write_physical(struct kvm_introspection *kvmi,
+                                const struct kvmi_msg_hdr *msg,
+                                const void *_req)
+{
+       const struct kvmi_vm_write_physical *req = _req;
+       int ec;
+
+       if (msg->size < sizeof(*req) + req->size)
+               return -EINVAL;
+
+       if (invalid_page_access(req->gpa, req->size))
+               ec = -KVM_EINVAL;
+       else
+               ec = kvmi_cmd_write_physical(kvmi->kvm, req->gpa,
+                                            req->size, req->data);
+
+       return kvmi_msg_vm_reply(kvmi, msg, ec, NULL, 0);
+}
+
 /*
  * These commands are executed by the receiving thread/worker.
  */
@@ -217,6 +261,8 @@ static int(*const msg_vm[])(struct kvm_introspection *,
        [KVMI_VM_CHECK_EVENT]    = handle_check_event,
        [KVMI_VM_CONTROL_EVENTS] = handle_vm_control_events,
        [KVMI_VM_GET_INFO]       = handle_get_info,
+       [KVMI_VM_READ_PHYSICAL]  = handle_read_physical,
+       [KVMI_VM_WRITE_PHYSICAL] = handle_write_physical,
 };
 
 static bool is_vm_message(u16 id)
_______________________________________________
Virtualization mailing list
[email protected]
https://lists.linuxfoundation.org/mailman/listinfo/virtualization

Reply via email to