palacios/src/palacios/vmm_mem_hook.c

   1 /*
   2  * This file is part of the Palacios Virtual Machine Monitor developed
   3  * by the V3VEE Project with funding from the United States National
   4  * Science Foundation and the Department of Energy.
   5  *
   6  * The V3VEE Project is a joint project between Northwestern University
   7  * and the University of New Mexico.  You can find out more at
   8  * http://www.v3vee.org
   9  *
  10  * Copyright (c) 2008, Jack Lange <jarusl@cs.northwestern.edu>
  11  * Copyright (c) 2008, The V3VEE Project <http://www.v3vee.org>
  12  * All rights reserved.
  13  *
  14  * Author: Jack Lange <jarusl@cs.northwestern.edu>
  15  *
  16  * This is free software.  You are permitted to use,
  17  * redistribute, and modify it as specified in the file "V3VEE_LICENSE".
  18  */
  19
  20 #include <palacios/vmm.h>
  21 #include <palacios/vm_guest.h>
  22 #include <palacios/vmm_mem_hook.h>
  23 #include <palacios/vmm_emulator.h>
  24 #include <palacios/vm_guest_mem.h>
  25
  26 struct mem_hook {
  27
  28     // Called when data is read from a memory page
  29     int (*read)(struct guest_info * core, addr_t guest_addr, void * dst, uint_t length, void * priv_data);
  30     // Called when data is written to a memory page
  31     int (*write)(struct guest_info * core, addr_t guest_addr, void * src, uint_t length, void * priv_data);
  32
  33     void * priv_data;
  34     addr_t hook_hva;
  35
  36
  37 };
  38
  39
  40
  41 int v3_init_mem_hooks(struct v3_vm_info * vm) {
  42     struct v3_mem_hooks * hooks = &(vm->mem_hooks);
  43
  44     hooks->hook_hvas = V3_VAddr(V3_AllocPages(vm->num_cores));
  45
  46     INIT_LIST_HEAD(&(hooks->hook_list));
  47
  48     return 0;
  49 }
  50
  51
  52
  53
  54 static int handle_mem_hook(struct guest_info * info, addr_t guest_va, addr_t guest_pa,
  55                            struct v3_mem_region * reg, pf_error_t access_info) {
  56     struct mem_hook * hook = reg->priv_data;
  57     addr_t op_addr = 0;
  58
  59     if (reg->flags.alloced == 0) {
  60         op_addr = hook->hook_hva;
  61     } else {
  62         if (v3_gpa_to_hva(info, guest_pa, &op_addr) == -1) {
  63             PrintError("Could not translate hook address (%p)\n", (void *)guest_pa);
  64             return -1;
  65         }
  66     }
  67
  68
  69     if (access_info.write == 1) {
  70         // Write Operation
  71
  72         if (v3_emulate_write_op(info, guest_va, guest_pa, op_addr,
  73                                 hook->write, hook->priv_data) == -1) {
  74             PrintError("Write Full Hook emulation failed\n");
  75             return -1;
  76         }
  77     } else {
  78         // Read Operation
  79
  80         if (reg->flags.read == 1) {
  81             PrintError("Tried to emulate read for a guest Readable page\n");
  82             return -1;
  83         }
  84
  85         if (v3_emulate_read_op(info, guest_va, guest_pa, op_addr,
  86                                hook->read, hook->write,
  87                                hook->priv_data) == -1) {
  88             PrintError("Read Full Hook emulation failed\n");
  89             return -1;
  90         }
  91
  92     }
  93
  94
  95     return 0;
  96 }
  97
  98
  99
 100
 101 int v3_hook_write_mem(struct v3_vm_info * vm, uint16_t core_id,
 102                       addr_t guest_addr_start, addr_t guest_addr_end, addr_t host_addr,
 103                       int (*write)(struct guest_info * core, addr_t guest_addr, void * src, uint_t length, void * priv_data),
 104                       void * priv_data) {
 105     struct v3_mem_region * entry = NULL;
 106     struct mem_hook * hook = V3_Malloc(sizeof(struct mem_hook));
 107     //    struct v3_mem_hooks * hooks = &(vm->mem_hooks);
 108
 109     memset(hook, 0, sizeof(struct mem_hook));
 110
 111     hook->write = write;
 112     hook->read = NULL;
 113     hook->priv_data = priv_data;
 114     hook->hook_hva = (addr_t)V3_VAddr((void *)host_addr);
 115
 116     entry = v3_create_mem_region(vm, core_id, guest_addr_start, guest_addr_end);
 117
 118     entry->host_addr = host_addr;
 119     entry->unhandled = handle_mem_hook;
 120     entry->priv_data = hook;
 121
 122     entry->flags.read = 1;
 123     entry->flags.exec = 1;
 124     entry->flags.alloced = 1;
 125
 126     if (v3_insert_mem_region(vm, entry) == -1) {
 127         V3_Free(entry);
 128         V3_Free(hook);
 129         return -1;
 130     }
 131
 132     return 0;
 133 }
 134
 135
 136
 137 int v3_hook_full_mem(struct v3_vm_info * vm, uint16_t core_id,
 138                      addr_t guest_addr_start, addr_t guest_addr_end,
 139                      int (*read)(struct guest_info * core, addr_t guest_addr, void * dst, uint_t length, void * priv_data),
 140                      int (*write)(struct guest_info * core, addr_t guest_addr, void * src, uint_t length, void * priv_data),
 141                      void * priv_data) {
 142
 143     struct v3_mem_region * entry = NULL;
 144     struct mem_hook * hook = V3_Malloc(sizeof(struct mem_hook));
 145     struct v3_mem_hooks * hooks = &(vm->mem_hooks);
 146
 147     memset(hook, 0, sizeof(struct mem_hook));
 148
 149     hook->write = write;
 150     hook->read = read;
 151     hook->priv_data = priv_data;
 152     hook->hook_hva = (addr_t)hooks->hook_hvas + (PAGE_SIZE_4KB * core_id);
 153
 154     entry = v3_create_mem_region(vm, core_id, guest_addr_start, guest_addr_end);
 155
 156     entry->unhandled = handle_mem_hook;
 157     entry->priv_data = hook;
 158
 159     if (v3_insert_mem_region(vm, entry)) {
 160         V3_Free(entry);
 161         V3_Free(hook);
 162         return -1;
 163     }
 164
 165     return 0;
 166 }
 167
 168
 169
 170 // This will unhook the memory hook registered at start address
 171 // We do not support unhooking subregions
 172 int v3_unhook_mem(struct v3_vm_info * vm, uint16_t core_id, addr_t guest_addr_start) {
 173     struct v3_mem_region * reg = v3_get_mem_region(vm, core_id, guest_addr_start);
 174     struct mem_hook * hook = reg->priv_data;
 175
 176     V3_Free(hook);
 177
 178     v3_delete_mem_region(vm, reg);
 179
 180     return 0;
 181 }
 182
 183