Palacios Public Git Repository

To checkout Palacios execute

  git clone http://v3vee.org/palacios/palacios.web/palacios.git
This will give you the master branch. You probably want the devel branch or one of the release branches. To switch to the devel branch, simply execute
  cd palacios
  git checkout --track -b devel origin/devel
The other branches are similar.


booting geekos up to the timer initialization
[palacios.git] / palacios / src / palacios / svm_ctrl_regs.c
index 198c09c..3586205 100644 (file)
@@ -42,7 +42,7 @@ int handle_cr0_write(struct guest_info * info) {
  
       addr_t first_operand;
       addr_t second_operand;
-      struct cr0_real *old_cr0;
+      struct cr0_real *real_cr0;
       struct cr0_real *new_cr0;
       operand_type_t addr_type;
       char new_cr0_val = 0;
@@ -50,8 +50,7 @@ int handle_cr0_write(struct guest_info * info) {
       // decode mod/RM
       index += 2;
  
-      old_cr0 = (struct cr0_real*)&(guest_state->cr0);
-
+      real_cr0 = (struct cr0_real*)&(guest_state->cr0);
 
       addr_type = decode_operands16(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG16);
 
@@ -72,9 +71,9 @@ int handle_cr0_write(struct guest_info * info) {
        return -1;
       }
                 
-      if ((new_cr0->pe == 1) && (old_cr0->pe == 0)) {
+      if ((new_cr0->pe == 1) && (real_cr0->pe == 0)) {
        info->cpu_mode = PROTECTED;
-      } else if ((new_cr0->pe == 0) && (old_cr0->pe == 1)) {
+      } else if ((new_cr0->pe == 0) && (real_cr0->pe == 1)) {
        info->cpu_mode = REAL;
       }
       
@@ -82,29 +81,89 @@ int handle_cr0_write(struct guest_info * info) {
 
 
       if (info->page_mode == SHADOW_PAGING) {
-       struct cr0_real * virt_cr0 = (struct cr0_real*)&(info->shdw_pg_state.guest_cr0);
+       struct cr0_real * shadow_cr0 = (struct cr0_real*)&(info->shdw_pg_state.guest_cr0);
 
+       PrintDebug("Old CR0=%x, Old Shadow CR0=%x\n", *real_cr0, *shadow_cr0);  
        /* struct cr0_real is only 4 bits wide, 
-        * so we can overwrite the old_cr0 without worrying about the shadow fields
+        * so we can overwrite the real_cr0 without worrying about the shadow fields
         */
-       *(char*)old_cr0 &= 0xf0;
-       *(char*)old_cr0 |= new_cr0_val;
+       *(char*)real_cr0 &= 0xf0;
+       *(char*)real_cr0 |= new_cr0_val;
        
-       *(char*)virt_cr0 &= 0xf0;
-       *(char*)virt_cr0 |= new_cr0_val;
+       *(char*)shadow_cr0 &= 0xf0;
+       *(char*)shadow_cr0 |= new_cr0_val;
+
+       PrintDebug("New CR0=%x, New Shadow CR0=%x\n", *real_cr0, *shadow_cr0);  
       } else {
+       PrintDebug("Old CR0=%x\n", *real_cr0);  
        // for now we just pass through....
-       *(char*)old_cr0 &= 0xf0;
-       *(char*)old_cr0 |= new_cr0_val;
+       *(char*)real_cr0 &= 0xf0;
+       *(char*)real_cr0 |= new_cr0_val;
+
+       PrintDebug("New CR0=%x\n", *real_cr0);  
       }
 
-      PrintDebug("index = %d, rip = %x\n", index, (ulong_t)(info->rip));
+
       info->rip += index;
-      PrintDebug("new_rip = %x\n", (ulong_t)(info->rip));
+
     } else if ((instr[index] == cr_access_byte) && 
               (instr[index + 1] == clts_byte)) {
       // CLTS
+
+
+    } else if ((instr[index] == cr_access_byte) && 
+              (instr[index + 1] = mov_to_cr_byte)) {
+      addr_t first_operand;
+      addr_t second_operand;
+      struct cr0_32 *real_cr0;
+      struct cr0_32 *new_cr0;
+      operand_type_t addr_type;
+     
+      
+      index += 2;
+      real_cr0 = (struct cr0_32*)&(guest_state->cr0);
+
+      addr_type = decode_operands16(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32);
+
+      if (addr_type != REG_OPERAND) {
+       /* Mov to CR0 Can only be a 32 bit register */
+       // FIX ME
+       return -1;
+      }
+
+      new_cr0 = (struct cr0_32 *)first_operand;
+
+      if (new_cr0->pe == 1) {
+       PrintDebug("Entering Protected Mode\n");
+       info->cpu_mode = PROTECTED;
+      }
+
+      if (new_cr0->pg == 1) {
+       // GPF the guest??
+       return -1;
+      }
+
+      if (info->page_mode == SHADOW_PAGING) {
+       struct cr0_32 * shadow_cr0 = (struct cr0_32 *)&(info->shdw_pg_state.guest_cr0);
+       
+       PrintDebug("Old CR0=%x, Old Shadow CR0=%x\n", *real_cr0, *shadow_cr0);  
+       *real_cr0 = *new_cr0;
+       real_cr0->pg = 1;
+
+       *shadow_cr0 = *new_cr0;
+
+       PrintDebug("New CR0=%x, New Shadow CR0=%x\n", *real_cr0, *shadow_cr0);  
+      } else {
+       PrintDebug("Old CR0=%x\n", *real_cr0);  
+       *real_cr0 = *new_cr0;
+       PrintDebug("New CR0=%x\n", *real_cr0);  
+      }
+
+      info->rip += index;
+
     } else {
+      PrintDebug("Unsupported Instruction\n");
       // unsupported instruction, UD the guest
       return -1;
     }
@@ -118,7 +177,7 @@ int handle_cr0_write(struct guest_info * info) {
 
     // The real rip address is actually a combination of the rip + CS base 
     ret = read_guest_pa_memory(info, get_addr_linear(info, guest_state->rip, guest_state->cs.base), 15, instr);
-    if (ret != 0) {
+    if (ret != 15) {
       // I think we should inject a GPF into the guest
       PrintDebug("Could not read instruction (ret=%d)\n", ret);
       return -1;
@@ -135,55 +194,55 @@ int handle_cr0_write(struct guest_info * info) {
     
       addr_t first_operand;
       addr_t second_operand;
-      struct cr0_32 *old_cr0;
+      struct cr0_32 *real_cr0;
       struct cr0_32 *new_cr0;
       operand_type_t addr_type;
 
       index += 2;
  
-      old_cr0 = (struct cr0_32*)&(guest_state->cr0);
+      real_cr0 = (struct cr0_32*)&(guest_state->cr0);
 
       addr_type = decode_operands32(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32);
 
-
-      if (addr_type == REG_OPERAND) {
-       new_cr0 = (struct cr0_32 *)first_operand;
-      } else if (addr_type == MEM_OPERAND) {
-       addr_t host_addr;
-
-       if (guest_pa_to_host_va(info, first_operand + guest_state->ds.base, &host_addr) == -1) {
-         // gpf the guest
-         return -1;
-       }
-
-       new_cr0 = (struct cr0_32 *)host_addr;
-      } else {
-       // error... don't know what to do
+      if (addr_type != REG_OPERAND) {
        return -1;
       }
 
+      new_cr0 = (struct cr0_32 *)first_operand;
+
 
       if (info->page_mode == SHADOW_PAGING) {
-       struct cr0_32 * virt_cr0 = (struct cr0_32 *)&(info->shdw_pg_state.guest_cr0);
+       struct cr0_32 * shadow_cr0 = (struct cr0_32 *)&(info->shdw_pg_state.guest_cr0);
 
-       if ((new_cr0->pg == 1) && (virt_cr0->pg == 0)){
+       if (new_cr0->pg == 1){
          info->cpu_mode = PROTECTED_PG;
+         
+         *shadow_cr0 = *new_cr0;
+         *real_cr0 = *new_cr0;
 
+         //
          // Activate Shadow Paging
+         //
+
+       } else if (new_cr0->pe == 0) {
+         info->cpu_mode = REAL;
+
+         *shadow_cr0 = *new_cr0;
+         *real_cr0 = *new_cr0;
+         real_cr0->pg = 1;
        }
 
-       *virt_cr0 = *new_cr0;
-       *old_cr0 = *new_cr0;
+
       } else {
-       // fill in
+       *real_cr0 = *new_cr0;
       }
 
       info->rip += index;
     }
     
-  } else {
+  } else { 
     PrintDebug("Unknown Mode write to CR0\n");
-    while(1);
+    return -1;
   }
   return 0;
 }
@@ -250,15 +309,39 @@ int handle_cr0_read(struct guest_info * info) {
       PrintDebug("index = %d, rip = %x\n", index, (ulong_t)(info->rip));
       info->rip += index;
       PrintDebug("new_rip = %x\n", (ulong_t)(info->rip));
-    } else {
-      addr_t host_addr;
+    } else if ((instr[index] == cr_access_byte) &&
+              (instr[index+1] == mov_from_cr_byte)) {
+      /* Mov from CR0
+       * This can only take a 32 bit register argument in anything less than 64 bit mode.
+       */
+      addr_t first_operand;
+      addr_t second_operand;
+      operand_type_t addr_type;
 
-      PrintDebug("Unknown read instr to CR0\n");
-      guest_pa_to_host_pa(info, get_addr_linear(info, guest_state->rip, guest_state->cs.selector), &host_addr);
-      
-      PrintDebug("Instr (15 bytes) at %x:\n", host_addr);
-      PrintTraceMemDump((char*)host_addr, 15);
+      struct cr0_32 * real_cr0 = (struct cr0_32 *)&(guest_state->cr0);
+
+      index += 2;
+
+      addr_type = decode_operands16(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32);
+     
+      struct cr0_32 * virt_cr0 = (struct cr0_32 *)first_operand;
+  
+      if (addr_type != REG_OPERAND) {
+       // invalid opcode to guest
+       PrintDebug("Invalid operand type in mov from CR0\n");
+       return -1;
+      }
+
+      if (info->page_mode == SHADOW_PAGING) {
+       *virt_cr0 = *(struct cr0_32 *)&(info->shdw_pg_state.guest_cr0);
+      } else {
+       *virt_cr0 = *real_cr0;
+      }
+
+      info->rip += index;
 
+    } else {
+      PrintDebug("Unknown read instr from CR0\n");
       return -1;
     }
 
@@ -279,6 +362,41 @@ int handle_cr0_read(struct guest_info * info) {
     }
 
 
+    if ((instr[index] == cr_access_byte) &&
+       (instr[index+1] == mov_from_cr_byte)) {
+      addr_t first_operand;
+      addr_t second_operand;
+      operand_type_t addr_type;
+      struct cr0_32 * virt_cr0;
+      struct cr0_32 * real_cr0 = (struct cr0_32 *)&(guest_state->cr0);
+
+      index += 2;
+
+      addr_type = decode_operands32(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32);
+
+      if (addr_type != REG_OPERAND) {
+       PrintDebug("Invalid operand type in mov from CR0\n");
+       return -1;
+      }
+      
+      virt_cr0 = (struct cr0_32 *)first_operand;
+
+      if (info->page_mode == SHADOW_PAGING) {
+       *virt_cr0 = *(struct cr0_32 *)&(info->shdw_pg_state.guest_cr0);
+      } else {
+       *virt_cr0 = *real_cr0;
+      }
+      
+      info->rip += index;
+
+    } else { 
+      PrintDebug("Unknown read instruction from CR0\n");
+      return -1;
+    }
+
+  } else {
+    PrintDebug("Unknown mode read from CR0\n");
+    return -1;
   }