palacios/src/palacios/vmm_msr.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
  21 #include <palacios/vmm_msr.h>
  22 #include <palacios/vmm.h>
  23 #include <palacios/vm_guest.h>
  24
  25 static int free_hook(struct v3_vm_info * vm, struct v3_msr_hook * hook);
  26
  27 void v3_init_msr_map(struct v3_vm_info * vm) {
  28     struct v3_msr_map * msr_map  = &(vm->msr_map);
  29
  30     PrintDebug("Initializing MSR map.\n");
  31
  32     INIT_LIST_HEAD(&(msr_map->hook_list));
  33     msr_map->num_hooks = 0;
  34
  35     msr_map->arch_data = NULL;
  36     msr_map->update_map = NULL;
  37 }
  38
  39 int v3_deinit_msr_map(struct v3_vm_info * vm) {
  40     struct v3_msr_hook * hook = NULL;
  41     struct v3_msr_hook * tmp = NULL;
  42
  43     list_for_each_entry_safe(hook, tmp, &(vm->msr_map.hook_list), link) {
  44         free_hook(vm, hook);
  45     }
  46
  47     return 0;
  48 }
  49
  50 int v3_handle_msr_write(struct guest_info * info) {
  51     uint32_t msr_num = info->vm_regs.rcx;
  52     struct v3_msr msr_val;
  53     struct v3_msr_hook * hook = NULL;
  54
  55     PrintDebug("MSR write for msr 0x%x\n", msr_num);
  56
  57     hook = v3_get_msr_hook(info->vm_info, msr_num);
  58
  59     if (!hook) {
  60         PrintError("Hook for MSR write %d not found\n", msr_num);
  61         return -1;
  62     }
  63
  64     msr_val.value = 0;
  65     msr_val.lo = info->vm_regs.rax;
  66     msr_val.hi = info->vm_regs.rdx;
  67
  68     if (hook->write(info, msr_num, msr_val, hook->priv_data) == -1) {
  69         PrintError("Error in MSR hook Write\n");
  70         return -1;
  71     }
  72
  73     info->rip += 2;
  74
  75     return 0;
  76 }
  77
  78
  79 int v3_handle_msr_read(struct guest_info * info) {
  80     uint32_t msr_num = info->vm_regs.rcx;
  81     struct v3_msr msr_val;
  82     struct v3_msr_hook * hook = NULL;
  83
  84     hook = v3_get_msr_hook(info->vm_info, msr_num);
  85
  86     if (!hook) {
  87         PrintError("Hook for MSR read 0x%x not found\n", msr_num);
  88         return -1;
  89     }
  90
  91     msr_val.value = 0;
  92
  93     if (hook->read(info, msr_num, &msr_val, hook->priv_data) == -1) {
  94         PrintError("Error in MSR hook Read\n");
  95         return -1;
  96     }
  97
  98     info->vm_regs.rax = msr_val.lo;
  99     info->vm_regs.rdx = msr_val.hi;
 100
 101     info->rip += 2;
 102     return 0;
 103 }
 104
 105 int v3_hook_msr(struct v3_vm_info * vm, uint32_t msr,
 106                 int (*read)(struct guest_info * core, uint32_t msr, struct v3_msr * dst, void * priv_data),
 107                 int (*write)(struct guest_info * core, uint32_t msr, struct v3_msr src, void * priv_data),
 108                 void * priv_data) {
 109
 110     struct v3_msr_map * msr_map = &(vm->msr_map);
 111     struct v3_msr_hook * hook = NULL;
 112
 113     hook = (struct v3_msr_hook *)V3_Malloc(sizeof(struct v3_msr_hook));
 114
 115     if (hook == NULL) {
 116         PrintError("Could not allocate msr hook for MSR 0x%x\n", msr);
 117         return -1;
 118     }
 119
 120     hook->read = read;
 121     hook->write = write;
 122     hook->msr = msr;
 123     hook->priv_data = priv_data;
 124
 125     msr_map->num_hooks++;
 126
 127     list_add(&(hook->link), &(msr_map->hook_list));
 128
 129     if (msr_map->update_map) {
 130         msr_map->update_map(vm, msr,
 131                             (read == NULL) ? 0 : 1,
 132                             (write == NULL) ? 0 : 1);
 133     }
 134
 135     return 0;
 136 }
 137
 138 static int free_hook(struct v3_vm_info * vm, struct v3_msr_hook * hook) {
 139     list_del(&(hook->link));
 140
 141     if (vm->msr_map.update_map) {
 142         vm->msr_map.update_map(vm, hook->msr, 0, 0);
 143     }
 144
 145     V3_Free(hook);
 146
 147     return 0;
 148 }
 149
 150
 151 int v3_unhook_msr(struct v3_vm_info * vm, uint32_t msr) {
 152     struct v3_msr_hook * hook = v3_get_msr_hook(vm, msr);
 153
 154     if (hook == NULL) {
 155         PrintError("Could not find MSR to unhook %u (0x%x)\n", msr, msr);
 156         return -1;
 157     }
 158
 159     free_hook(vm, hook);
 160
 161     return 0;
 162 }
 163
 164
 165
 166 struct v3_msr_hook * v3_get_msr_hook(struct v3_vm_info * vm, uint32_t msr) {
 167     struct v3_msr_map * msr_map = &(vm->msr_map);
 168     struct v3_msr_hook * hook = NULL;
 169
 170     list_for_each_entry(hook, &(msr_map->hook_list), link) {
 171         if (hook->msr == msr) {
 172             return hook;
 173         }
 174     }
 175
 176     return NULL;
 177 }
 178
 179
 180 void v3_refresh_msr_map(struct v3_vm_info * vm) {
 181     struct v3_msr_map * msr_map = &(vm->msr_map);
 182     struct v3_msr_hook * hook = NULL;
 183
 184     if (msr_map->update_map == NULL) {
 185         PrintError("Trying to refresh an MSR map with no backend\n");
 186         return;
 187     }
 188
 189     list_for_each_entry(hook, &(msr_map->hook_list), link) {
 190         PrintDebug("updating MSR map for msr 0x%x\n", hook->msr);
 191         msr_map->update_map(vm, hook->msr,
 192                             (hook->read == NULL) ? 0 : 1,
 193                             (hook->write == NULL) ? 0 : 1);
 194     }
 195 }
 196
 197 void v3_print_msr_map(struct v3_vm_info * vm) {
 198     struct v3_msr_map * msr_map = &(vm->msr_map);
 199     struct v3_msr_hook * hook = NULL;
 200
 201     list_for_each_entry(hook, &(msr_map->hook_list), link) {
 202         V3_Print("MSR HOOK (MSR=0x%x) (read=0x%p) (write=0x%p)\n",
 203                    hook->msr, hook->read, hook->write);
 204     }
 205 }