huge update for merge

[palacios.git] / palacios / src / palacios / svm_handler.c

diff --git a/palacios/src/palacios/svm_handler.c b/palacios/src/palacios/svm_handler.c
index 0b2028c..f4311cb 100644 (file)
--- a/palacios/src/palacios/svm_handler.c
+++ b/palacios/src/palacios/svm_handler.c
@@ -32,7 +32,7 @@
 #include <palacios/svm_msr.h>
 #include <palacios/vmm_profiler.h>
 #include <palacios/vmm_hypercall.h>
-
+#include <palacios/vmm_direct_paging.h>
 
 
 
@@ -73,13 +73,25 @@ int v3_handle_svm_exit(struct guest_info * info) {
 
     if ((info->intr_state.irq_pending == 1) && (guest_ctrl->guest_ctrl.V_IRQ == 0)) {
        // Interrupt was taken in the guest
+       if (exit_code == VMEXIT_EXCP14) {
+           PrintError("Page fault immeidately after interrupt injection (%d)\n", info->intr_state.irq_vector);
+       }
+
+#ifdef DEBUG_INTERRUPTS
+       PrintDebug("Interrupt %d taken by guest\n", info->intr_state.irq_vector);
+#endif
+       if (!guest_ctrl->exit_int_info.valid) {
+           info->intr_state.irq_pending = 0;
+           // PrintDebug("Injecting Interrupt %d\n", info->intr_state.irq_vector);
+           v3_injecting_intr(info, info->intr_state.irq_vector, EXTERNAL_IRQ);
+       } else {
 #ifdef DEBUG_INTERRUPTS
-       PrintDebug("Interrupt taken by guest\n");
+           PrintDebug("EXIT INT INFO is set (vec=%d)\n", guest_ctrl->exit_int_info.vector);
 #endif
-       v3_injecting_intr(info, info->intr_state.irq_vector, EXTERNAL_IRQ);
+       }
     }
 
-    info->intr_state.irq_pending = 0;
+
   
 
     // Disable printing io exits due to bochs debug messages
@@ -241,12 +253,20 @@ int v3_handle_svm_exit(struct guest_info * info) {
            }
            break;
        } 
-       case VMEXIT_NPF: 
+       case VMEXIT_NPF: {
+           addr_t fault_addr = guest_ctrl->exit_info2;
+           pf_error_t * error_code = (pf_error_t *)&(guest_ctrl->exit_info1);
 
-           PrintError("Currently unhandled Nested Page Fault\n");
-           return -1;
-               
+           if (info->shdw_pg_mode == NESTED_PAGING) {
+               if (v3_handle_nested_pagefault(info, fault_addr, *error_code) == -1) {
+                   return -1;
+               }
+           } else {
+               PrintError("Currently unhandled Nested Page Fault\n");
+               return -1;
+                   }
            break;
+           }
        case VMEXIT_INVLPG: 
            if (info->shdw_pg_mode == SHADOW_PAGING) {
 #ifdef DEBUG_SHADOW_PAGING
@@ -346,8 +366,36 @@ int v3_handle_svm_exit(struct guest_info * info) {
 
 
     // Update the low level state
+    if (info->intr_state.irq_pending == 1) {
 
-    if (v3_intr_pending(info)) {
+       guest_ctrl->guest_ctrl.V_IRQ = 1;
+       guest_ctrl->guest_ctrl.V_INTR_VECTOR = info->intr_state.irq_vector;
+       guest_ctrl->guest_ctrl.V_IGN_TPR = 1;
+       guest_ctrl->guest_ctrl.V_INTR_PRIO = 0xf;
+
+    } else if (v3_excp_pending(info)) {
+       uint_t excp = v3_get_excp_number(info);
+               
+       guest_ctrl->EVENTINJ.type = SVM_INJECTION_EXCEPTION;
+       
+       if (info->excp_state.excp_error_code_valid) {
+           guest_ctrl->EVENTINJ.error_code = info->excp_state.excp_error_code;
+           guest_ctrl->EVENTINJ.ev = 1;
+#ifdef DEBUG_INTERRUPTS
+           PrintDebug("Injecting exception %d with error code %x\n", excp, guest_ctrl->EVENTINJ.error_code);
+#endif
+       }
+       
+       guest_ctrl->EVENTINJ.vector = excp;
+       
+       guest_ctrl->EVENTINJ.valid = 1;
+#ifdef DEBUG_INTERRUPTS
+       PrintDebug("Injecting Exception %d (EIP=%p)\n", 
+                  guest_ctrl->EVENTINJ.vector, 
+                  (void *)(addr_t)info->rip);
+#endif
+       v3_injecting_excp(info, excp);
+    } else if (v3_intr_pending(info)) {
 
        switch (v3_get_intr_type(info)) {
            case EXTERNAL_IRQ: {
@@ -355,54 +403,26 @@ int v3_handle_svm_exit(struct guest_info * info) {
                    
                // check to see if ==-1 (non exists)
                    
-               /*      
-                 guest_ctrl->EVENTINJ.vector = irq;
-                 guest_ctrl->EVENTINJ.valid = 1;
-                 guest_ctrl->EVENTINJ.type = SVM_INJECTION_EXTERNAL_INTR;
-               */
                    
                guest_ctrl->guest_ctrl.V_IRQ = 1;
                guest_ctrl->guest_ctrl.V_INTR_VECTOR = irq;
                guest_ctrl->guest_ctrl.V_IGN_TPR = 1;
                guest_ctrl->guest_ctrl.V_INTR_PRIO = 0xf;
+
 #ifdef DEBUG_INTERRUPTS
                PrintDebug("Injecting Interrupt %d (EIP=%p)\n", 
                           guest_ctrl->guest_ctrl.V_INTR_VECTOR, 
                           (void *)(addr_t)info->rip);
 #endif
+
                info->intr_state.irq_pending = 1;
                info->intr_state.irq_vector = irq;
-
                    
                break;
            }
            case NMI:
                guest_ctrl->EVENTINJ.type = SVM_INJECTION_NMI;
                break;
-           case EXCEPTION: {
-               uint_t excp = v3_get_intr_number(info);
-               
-               guest_ctrl->EVENTINJ.type = SVM_INJECTION_EXCEPTION;
-               
-               if (info->intr_state.excp_error_code_valid) {  //PAD
-                   guest_ctrl->EVENTINJ.error_code = info->intr_state.excp_error_code;
-                   guest_ctrl->EVENTINJ.ev = 1;
-#ifdef DEBUG_INTERRUPTS
-                   PrintDebug("Injecting error code %x\n", guest_ctrl->EVENTINJ.error_code);
-#endif
-               }
-               
-               guest_ctrl->EVENTINJ.vector = excp;
-               
-               guest_ctrl->EVENTINJ.valid = 1;
-#ifdef DEBUG_INTERRUPTS
-               PrintDebug("Injecting Interrupt %d (EIP=%p)\n", 
-                          guest_ctrl->EVENTINJ.vector, 
-                          (void *)(addr_t)info->rip);
-#endif
-               v3_injecting_intr(info, excp, EXCEPTION);
-               break;
-           }
            case SOFTWARE_INTR:
                guest_ctrl->EVENTINJ.type = SVM_INJECTION_SOFT_INTR;
                break;