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.


*** empty log message ***
[palacios.git] / palacios / src / palacios / vmm_ctrl_regs.c
index 245ba44..69d51ff 100644 (file)
@@ -9,6 +9,81 @@
 
 extern void SerialMemDump(unsigned char *start, int n);
 
+
+#if VMM_DEBUG
+void PrintCtrlRegs(struct guest_info *info)
+{
+  struct cr0_32 cr0 = *((struct cr0_32 *) &(info->ctrl_regs.cr0));
+  struct cr2_32 cr2 = *((struct cr2_32 *) &(info->ctrl_regs.cr2));
+  struct cr3_32 cr3 = *((struct cr3_32 *) &(info->ctrl_regs.cr3));
+  struct cr4_32 cr4 = *((struct cr4_32 *) &(info->ctrl_regs.cr4));
+  struct rflags rflags = *((struct rflags *) &(info->ctrl_regs.rflags));
+
+  PrintDebug("CR0:     pe    0x%x\n",cr0.pe);
+  PrintDebug("CR0:     mp    0x%x\n",cr0.mp);
+  PrintDebug("CR0:     em    0x%x\n",cr0.em);
+  PrintDebug("CR0:     ts    0x%x\n",cr0.ts);
+  PrintDebug("CR0:     et    0x%x\n",cr0.et);
+  PrintDebug("CR0:     ne    0x%x\n",cr0.ne);
+  PrintDebug("CR0:     rsvd1 0x%x\n",cr0.rsvd1);
+  PrintDebug("CR0:     wp    0x%x\n",cr0.wp);
+  PrintDebug("CR0:     rsvd2 0x%x\n",cr0.rsvd2);
+  PrintDebug("CR0:     am    0x%x\n",cr0.am);
+  PrintDebug("CR0:     rsvd3 0x%x\n",cr0.rsvd3);
+  PrintDebug("CR0:     nw    0x%x\n",cr0.nw);
+  PrintDebug("CR0:     cd    0x%x\n",cr0.cd);
+  PrintDebug("CR0:     pg    0x%x\n",cr0.pg);
+
+  PrintDebug("CR2:     pfadd 0x%x\n",cr2.pf_vaddr);
+
+  PrintDebug("CR3:     rsvd1 0x%x\n",cr3.rsvd1);
+  PrintDebug("CR3:     pwt   0x%x\n",cr3.pwt);
+  PrintDebug("CR3:     pcd   0x%x\n",cr3.pcd);
+  PrintDebug("CR3:     rsvd2 0x%x\n",cr3.rsvd2);
+  PrintDebug("CR3:     pdt   0x%x\n",cr3.pdt_base_addr);
+
+  PrintDebug("CR4:     vme   0x%x\n",cr4.vme);
+  PrintDebug("CR4:     pvi   0x%x\n",cr4.pvi);
+  PrintDebug("CR4:     tsd   0x%x\n",cr4.tsd);
+  PrintDebug("CR4:     de    0x%x\n",cr4.de);
+  PrintDebug("CR4:     pse   0x%x\n",cr4.pse);
+  PrintDebug("CR4:     pae   0x%x\n",cr4.pae);
+  PrintDebug("CR4:     mce   0x%x\n",cr4.mce);
+  PrintDebug("CR4:     pge   0x%x\n",cr4.pge);
+  PrintDebug("CR4:     pce   0x%x\n",cr4.pce);
+  PrintDebug("CR4:     osfx  0x%x\n",cr4.osf_xsr);
+  PrintDebug("CR4:     osx   0x%x\n",cr4.osx);
+  PrintDebug("CR4:     rsvd1 0x%x\n",cr4.rsvd1);
+
+  PrintDebug("RFLAGS:  cf    0x%x\n",rflags.cf);
+  PrintDebug("RFLAGS:  rsvd1 0x%x\n",rflags.rsvd1);
+  PrintDebug("RFLAGS:  pf    0x%x\n",rflags.pf);
+  PrintDebug("RFLAGS:  rsvd2 0x%x\n",rflags.rsvd2);
+  PrintDebug("RFLAGS:  af    0x%x\n",rflags.af);
+  PrintDebug("RFLAGS:  rsvd3 0x%x\n",rflags.rsvd3);
+  PrintDebug("RFLAGS:  zf    0x%x\n",rflags.zf);
+  PrintDebug("RFLAGS:  sf    0x%x\n",rflags.sf);
+  PrintDebug("RFLAGS:  tf    0x%x\n",rflags.tf);
+  PrintDebug("RFLAGS:  intr  0x%x\n",rflags.intr);
+  PrintDebug("RFLAGS:  df    0x%x\n",rflags.df);
+  PrintDebug("RFLAGS:  of    0x%x\n",rflags.of);
+  PrintDebug("RFLAGS:  iopl  0x%x\n",rflags.iopl);
+  PrintDebug("RFLAGS:  nt    0x%x\n",rflags.nt);
+  PrintDebug("RFLAGS:  rsvd4 0x%x\n",rflags.rsvd4);
+  PrintDebug("RFLAGS:  rf    0x%x\n",rflags.rf);
+  PrintDebug("RFLAGS:  vm    0x%x\n",rflags.vm);
+  PrintDebug("RFLAGS:  ac    0x%x\n",rflags.ac);
+  PrintDebug("RFLAGS:  vif   0x%x\n",rflags.vif);
+  PrintDebug("RFLAGS:  id    0x%x\n",rflags.id);
+  PrintDebug("RFLAGS:  rsvd5 0x%x\n",rflags.rsvd5);
+  PrintDebug("RFLAGS:  rsvd6 0x%x\n",rflags.rsvd6);
+
+}
+#else
+void PrintCtrlRegs(struct guest_info *info)
+{}
+#endif
+
 /* Segmentation is a problem here...
  *
  * When we get a memory operand, presumably we use the default segment (which is?) 
@@ -85,7 +160,7 @@ int handle_cr0_write(struct guest_info * info) {
        new_cr0_val = *(char*)(new_cr0) & 0x0f;
 
 
-       if (info->page_mode == SHADOW_PAGING) {
+       if (info->shdw_pg_mode == SHADOW_PAGING) {
          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);        
@@ -98,6 +173,7 @@ int handle_cr0_write(struct guest_info * info) {
          *(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);        
@@ -146,6 +222,12 @@ int handle_cr0_write(struct guest_info * info) {
          info->cpu_mode = PROTECTED;
        }
 
+       if (new_cr0->pe == 0) { 
+         PrintDebug("Entering Real Mode\n");
+         info->cpu_mode = REAL;
+       }
+         
+
        if (new_cr0->pg == 1) {
          PrintDebug("Paging is already turned on in switch to protected mode in CR0 write\n");
 
@@ -153,14 +235,16 @@ int handle_cr0_write(struct guest_info * info) {
          return -1;
        }
 
-       if (info->page_mode == SHADOW_PAGING) {
+       if (info->shdw_pg_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;
+         real_cr0->et = 1;
 
          *shadow_cr0 = *new_cr0;
+         shadow_cr0->et = 1;
 
          PrintDebug("New CR0=%x, New Shadow CR0=%x\n", *real_cr0, *shadow_cr0);        
        } else {
@@ -181,27 +265,27 @@ int handle_cr0_write(struct guest_info * info) {
     break;
  
   case PROTECTED: 
-  case PROTECTED_PG:
     {
 
       int index = 0;
       int ret;
 
       PrintDebug("Protected %s Mode write to CR0 at guest %s linear rip 0x%x\n", 
-                info->cpu_mode==PROTECTED_PG ? "Paged" : "",
-                info->cpu_mode==PROTECTED_PG ? "virtual" : "",
-                get_addr_linear(info,info->rip,&(info->segments.cs)));
+                info->mem_mode == VIRTUAL_MEM ? "Paged" : "",
+                info->mem_mode == VIRTUAL_MEM ? "virtual" : "",
+                get_addr_linear(info, info->rip, &(info->segments.cs)));
 
       // OK, now we will read the instruction
       // The only difference between PROTECTED and PROTECTED_PG is whether we read
       // from guest_pa or guest_va
-      if (info->cpu_mode==PROTECTED) { 
+      if (info->mem_mode == PHYSICAL_MEM) { 
        // The real rip address is actually a combination of the rip + CS base 
        ret = read_guest_pa_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
-      } else { //PROTECTED_PG
+      } else { 
        ret = read_guest_va_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
       }
        
+
       if (ret != 15) {
        // I think we should inject a GPF into the guest
        PrintDebug("Could not read instruction (ret=%d)\n", ret);
@@ -228,6 +312,9 @@ int handle_cr0_write(struct guest_info * info) {
 
        index += 2;
  
+       PrintDebug("MovToCR0 instr:\n");
+       PrintTraceMemDump(instr, 15);
+       PrintDebug("EAX=%x\n", *(uint_t*)&(info->vm_regs.rax));
 
        addr_type = decode_operands32(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32);
 
@@ -238,9 +325,9 @@ int handle_cr0_write(struct guest_info * info) {
 
        new_cr0 = (struct cr0_32 *)first_operand;
 
+       PrintDebug("first operand=%x\n", *(uint_t *)first_operand);
 
-
-       if (info->page_mode == SHADOW_PAGING) {
+       if (info->shdw_pg_mode == SHADOW_PAGING) {
          struct cr0_32 * shadow_cr0 = (struct cr0_32 *)&(info->shdw_pg_state.guest_cr0);
 
          if (new_cr0->pg == 1){
@@ -249,10 +336,12 @@ int handle_cr0_write(struct guest_info * info) {
 
            struct cr3_32 * shadow_cr3 = (struct cr3_32 *)&(info->shdw_pg_state.shadow_cr3);
 
-           info->cpu_mode = PROTECTED_PG;
+           info->mem_mode = VIRTUAL_MEM;
          
            *shadow_cr0 = *new_cr0;
            *real_cr0 = *new_cr0;
+           shadow_cr0->et = 1;
+           real_cr0->et = 1;
 
            //
            // Activate Shadow Paging
@@ -264,10 +353,25 @@ int handle_cr0_write(struct guest_info * info) {
 
          } else if (new_cr0->pe == 0) {
            info->cpu_mode = REAL;
+           info->mem_mode = PHYSICAL_MEM;
+           PrintDebug("Entering Real Mode\n");
+
+           PrintV3CtrlRegs(&(info->ctrl_regs));
+           // reinstate the identity mapped paged tables
+           // But keep the shadow tables around to handle TLB issues.... UGH...
+           //info->shdw_pg_state.shadow_cr3 &= 0x00000fff;
+           //info->shdw_pg_state.shadow_cr3 |= ((addr_t)create_passthrough_pde32_pts(info) & ~0xfff);
+
+           //info->ctrl_regs.cr3 = info->shdw_pg_state.shadow_cr3;
+           info->ctrl_regs.cr3 = ((addr_t)create_passthrough_pde32_pts(info) & ~0xfff);
+
 
            *shadow_cr0 = *new_cr0;
            *real_cr0 = *new_cr0;
            real_cr0->pg = 1;
+           shadow_cr0->et = 1;
+           real_cr0->et = 1;
+
          }
 
 
@@ -281,8 +385,8 @@ int handle_cr0_write(struct guest_info * info) {
                 (instr[index + 1] == 0x06)) { 
        // CLTS instruction
        PrintDebug("CLTS instruction - clearing TS flag of real and shadow CR0\n");
-       shadow_cr0->ts=0;
-       real_cr0->ts=0;
+       shadow_cr0->ts = 0;
+       real_cr0->ts = 0;
        
        index+=2;
        
@@ -300,18 +404,10 @@ int handle_cr0_write(struct guest_info * info) {
     PrintDebug("Protected PAE Mode write to CR0 is UNIMPLEMENTED\n");
     return -1;
 
-  case PROTECTED_PAE_PG:
-    PrintDebug("Protected PAE Paged Mode write to CR0 is UNIMPLEMENTED\n");
-    return -1;
-
   case LONG:
     PrintDebug("Protected Long Mode write to CR0 is UNIMPLEMENTED\n");
     return -1;
 
-  case LONG_PG:
-    PrintDebug("Protected Long Paged Mode write to CR0 is UNIMPLEMENTED\n");
-    return -1;
-
   default: 
     {
       PrintDebug("Unknown Mode write to CR0 (info->cpu_mode=0x%x\n)",info->cpu_mode);
@@ -418,7 +514,7 @@ int handle_cr0_read(struct guest_info * info) {
          return -1;
        }
 
-       if (info->page_mode == SHADOW_PAGING) {
+       if (info->shdw_pg_mode == SHADOW_PAGING) {
          *virt_cr0 = *(struct cr0_32 *)&(info->shdw_pg_state.guest_cr0);
        } else {
          *virt_cr0 = *real_cr0;
@@ -436,23 +532,22 @@ int handle_cr0_read(struct guest_info * info) {
     break;
 
   case PROTECTED:
-  case PROTECTED_PG:
     {
     
       int index = 0;
       int ret;
 
       PrintDebug("Protected %s Mode read from CR0 at guest %s linear rip 0x%x\n", 
-                info->cpu_mode==PROTECTED_PG ? "Paged" : "",
-                info->cpu_mode==PROTECTED_PG ? "virtual" : "",
-                get_addr_linear(info,info->rip,&(info->segments.cs)));
+                info->mem_mode == VIRTUAL_MEM ? "Paged" : "",
+                info->mem_mode == VIRTUAL_MEM ? "virtual" : "",
+                get_addr_linear(info, info->rip, &(info->segments.cs)));
 
       // We need to read the instruction, which is at CS:IP, but that 
       // linear address is guest physical without PG and guest virtual with PG
-      if (info->cpu_mode==PROTECTED) { 
+      if (info->cpu_mode == PHYSICAL_MEM) { 
        // The real rip address is actually a combination of the rip + CS base 
        ret = read_guest_pa_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
-      } else { // PROTECTED_PG
+      } else { 
        // The real rip address is actually a combination of the rip + CS base 
        ret = read_guest_va_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
       }
@@ -460,7 +555,7 @@ int handle_cr0_read(struct guest_info * info) {
       if (ret != 15) {
        // I think we should inject a GPF into the guest
        PrintDebug("Could not read Protected %s mode instruction (ret=%d)\n", 
-                  info->cpu_mode==PROTECTED_PG ? "Paged" : "", ret);
+                  info->cpu_mode == VIRTUAL_MEM ? "Paged" : "", ret);
        return -1;
       }
 
@@ -491,8 +586,17 @@ int handle_cr0_read(struct guest_info * info) {
       
        virt_cr0 = (struct cr0_32 *)first_operand;
 
-       if (info->page_mode == SHADOW_PAGING) {
+       if (info->shdw_pg_mode == SHADOW_PAGING) {
          *virt_cr0 = *(struct cr0_32 *)&(info->shdw_pg_state.guest_cr0);
+         
+         if (info->mem_mode == PHYSICAL_MEM) {
+           virt_cr0->pg = 0; // clear the pg bit because guest doesn't think it's on
+         }
+
+         PrintDebug("real CR0: %x\n", *(uint_t*)real_cr0);
+         PrintDebug("returned CR0: %x\n", *(uint_t*)virt_cr0);
+
+         
        } else {
          *virt_cr0 = *real_cr0;
        }
@@ -510,17 +614,11 @@ int handle_cr0_read(struct guest_info * info) {
     PrintDebug("Protected PAE Mode read to CR0 is UNIMPLEMENTED\n");
     return -1;
 
-  case PROTECTED_PAE_PG:
-    PrintDebug("Protected PAE Paged Mode read to CR0 is UNIMPLEMENTED\n");
-    return -1;
-
   case LONG:
     PrintDebug("Protected Long Mode read to CR0 is UNIMPLEMENTED\n");
     return -1;
 
-  case LONG_PG:
-    PrintDebug("Protected Long Paged Mode read to CR0 is UNIMPLEMENTED\n");
-    return -1;
+
   default:
     {
       PrintDebug("Unknown Mode read from CR0 (info->cpu_mode=0x%x)\n",info->cpu_mode);
@@ -537,14 +635,28 @@ int handle_cr0_read(struct guest_info * info) {
 
 
 int handle_cr3_write(struct guest_info * info) {
-  if ((info->cpu_mode == PROTECTED) || (info->cpu_mode == PROTECTED_PG)) {
+  if (info->cpu_mode == PROTECTED) {
     int index = 0;
     int ret;
     char instr[15];
 
+    PrintDebug("Protected %s mode write to CR3 at %s 0x%x\n",
+              info->cpu_mode==PROTECTED ? "" : "Paged", 
+              info->cpu_mode==PROTECTED ? "guest physical" : "guest virtual",
+              get_addr_linear(info,info->rip,&(info->segments.cs)));
+
+    // We need to read the instruction, which is at CS:IP, but that 
+    // linear address is guest physical without PG and guest virtual with PG
+    if (info->mem_mode == PHYSICAL_MEM) { 
+      // The real rip address is actually a combination of the rip + CS base 
+      PrintDebug("Writing Guest CR3 Write (Physical Address)\n");
+      ret = read_guest_pa_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
+    } else { 
+      PrintDebug("Writing Guest CR3 Write (Virtual Address)\n");
+      // The real rip address is actually a combination of the rip + CS base 
+      ret = read_guest_va_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
+    }
 
-    /* Isn't the RIP a Guest Virtual Address???????? */
-    ret = read_guest_pa_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
     if (ret != 15) {
       PrintDebug("Could not read instruction (ret=%d)\n", ret);
       return -1;
@@ -574,30 +686,53 @@ int handle_cr3_write(struct guest_info * info) {
 
       new_cr3 = (struct cr3_32 *)first_operand;
 
-      if (info->page_mode == SHADOW_PAGING) {
+      if (info->shdw_pg_mode == SHADOW_PAGING) {
        addr_t shadow_pt;
        struct cr3_32 * shadow_cr3 = (struct cr3_32 *)&(info->shdw_pg_state.shadow_cr3);
        struct cr3_32 * guest_cr3 = (struct cr3_32 *)&(info->shdw_pg_state.guest_cr3);
 
-       PrintDebug("fooo1\n");
+
+         if (CR3_TO_PDE32(*(uint_t*)shadow_cr3) != 0) {
+           PrintDebug("Shadow Page Table\n");
+           PrintDebugPageTables((pde32_t *)CR3_TO_PDE32(*(uint_t*)shadow_cr3));
+         }
 
        /* Delete the current Page Tables */
        delete_page_tables_pde32((pde32_t *)CR3_TO_PDE32(*(uint_t*)shadow_cr3));
 
-       PrintDebug("fooo2\n");
+       PrintDebug("Old Shadow CR3=%x; Old Guest CR3=%x\n", 
+                  *(uint_t*)shadow_cr3, *(uint_t*)guest_cr3);
+
+
        *guest_cr3 = *new_cr3;
 
+
+
        // Something like this
        shadow_pt =  create_new_shadow_pt32(info);
        //shadow_pt = setup_shadow_pt32(info, CR3_TO_PDE32(*(addr_t *)new_cr3));
 
-
        /* Copy Various flags */
        *shadow_cr3 = *new_cr3;
+
+       {
+         addr_t tmp_addr;
+         guest_pa_to_host_va(info, ((*(uint_t*)guest_cr3) & 0xfffff000), &tmp_addr);
+         PrintDebug("Guest PD\n");
+         PrintPD32((pde32_t *)tmp_addr);
+
+       }
+       
+
        
        shadow_cr3->pdt_base_addr = PD32_BASE_ADDR(shadow_pt);
 
-       if (info->cpu_mode == PROTECTED_PG) {
+       PrintDebug("New Shadow CR3=%x; New Guest CR3=%x\n", 
+                  *(uint_t*)shadow_cr3, *(uint_t*)guest_cr3);
+
+
+
+       if (info->mem_mode == VIRTUAL_MEM) {
          // If we aren't in paged mode then we have to preserve the identity mapped CR3
          info->ctrl_regs.cr3 = *(addr_t*)shadow_cr3;
        }
@@ -607,10 +742,11 @@ int handle_cr3_write(struct guest_info * info) {
 
     } else {
       PrintDebug("Unknown Instruction\n");
+      SerialMemDump(instr,15);
       return -1;
     }
   } else {
-    PrintDebug("Invalid operating Mode\n");
+    PrintDebug("Invalid operating Mode (0x%x)\n", info->cpu_mode);
     return -1;
   }
 
@@ -621,12 +757,53 @@ int handle_cr3_write(struct guest_info * info) {
 
 
 int handle_cr3_read(struct guest_info * info) {
-  if ((info->cpu_mode == PROTECTED) || (info->cpu_mode == PROTECTED_PG)) {
+
+  if (info->cpu_mode == REAL) {
+    // what does this mean???
+
+    /*
+
+    addr_t host_addr;
+    addr_t linear_addr = 0;
+
+
+
+    linear_addr = get_addr_linear(info, info->rip, &(info->segments.cs));
+
+    
+    PrintDebug("RIP Linear: %x\n", linear_addr);
+    PrintV3Segments(&(info->segments));
+    
+      
+    if (info->mem_mode == PHYSICAL_MEM) {
+      guest_pa_to_host_pa(info, linear_addr, &host_addr);
+    } else if (info->mem_mode == VIRTUAL_MEM) {
+      guest_va_to_host_pa(info, linear_addr, &host_addr);
+    }
+
+
+    pt32_lookup((pde32_t *)CR3_TO_PDE32(info->shdw_pg_state.shadow_cr3), , addr_t * paddr);
+    */
+
+
+    return -1;
+  } else if (info->cpu_mode == PROTECTED) {
+
     int index = 0;
     int ret;
     char instr[15];
 
-    ret = read_guest_pa_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
+   
+    // We need to read the instruction, which is at CS:IP, but that 
+    // linear address is guest physical without PG and guest virtual with PG
+    if (info->cpu_mode == PHYSICAL_MEM) { 
+      // The real rip address is actually a combination of the rip + CS base 
+      ret = read_guest_pa_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
+    } else { 
+      // The real rip address is actually a combination of the rip + CS base 
+      ret = read_guest_va_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr);
+    }
+
     if (ret != 15) {
       PrintDebug("Could not read instruction (ret=%d)\n", ret);
       return -1;
@@ -655,7 +832,7 @@ int handle_cr3_read(struct guest_info * info) {
 
       virt_cr3 = (struct cr3_32 *)first_operand;
 
-      if (info->page_mode == SHADOW_PAGING) {
+      if (info->shdw_pg_mode == SHADOW_PAGING) {
        *virt_cr3 = *(struct cr3_32 *)&(info->shdw_pg_state.guest_cr3);
       } else {
        *virt_cr3 = *real_cr3;
@@ -664,10 +841,12 @@ int handle_cr3_read(struct guest_info * info) {
       info->rip += index;
     } else {
       PrintDebug("Unknown Instruction\n");
+      SerialMemDump(instr,15);
       return -1;
     }
   } else {
-    PrintDebug("Invalid operating Mode\n");
+    PrintDebug("Invalid operating Mode (0x%x), control registers follow\n", info->cpu_mode);
+    PrintCtrlRegs(info);
     return -1;
   }