X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?a=blobdiff_plain;f=palacios%2Fsrc%2Fpalacios%2Fvmm_ctrl_regs.c;h=ba83f3b6010c448e05ab963edd4dbc31cc5d27b3;hb=07820ee58e9b356341ce86cd2b2938d3abef60c9;hp=7d59b82667bd41a5f42e90c0805f788a838329ef;hpb=1c63b0651a5d039076d8027c7cd87960e4151408;p=palacios.git diff --git a/palacios/src/palacios/vmm_ctrl_regs.c b/palacios/src/palacios/vmm_ctrl_regs.c index 7d59b82..ba83f3b 100644 --- a/palacios/src/palacios/vmm_ctrl_regs.c +++ b/palacios/src/palacios/vmm_ctrl_regs.c @@ -6,6 +6,7 @@ #include + /* Segmentation is a problem here... * * When we get a memory operand, presumably we use the default segment (which is?) @@ -13,417 +14,551 @@ */ +#ifndef DEBUG_CTRL_REGS +#undef PrintDebug +#define PrintDebug(fmt, args...) +#endif + + + + + + + int handle_cr0_write(struct guest_info * info) { char instr[15]; - - - if (info->cpu_mode == REAL) { - int index = 0; - int ret; + int ret; + struct x86_instr dec_instr; - // The real rip address is actually a combination of the rip + CS base + if (info->mem_mode == PHYSICAL_MEM) { ret = read_guest_pa_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); - return -1; - } + } else { + ret = read_guest_va_memory(info, get_addr_linear(info, info->rip, &(info->segments.cs)), 15, instr); + } - while (is_prefix_byte(instr[index])) { - index++; - } + if (ret != 15) { + // I think we should inject a GPF into the guest + PrintError("Could not read instruction (ret=%d)\n", ret); + return -1; + } - if ((instr[index] == cr_access_byte) && - (instr[index + 1] == lmsw_byte) && - (MODRM_REG(instr[index + 2]) == lmsw_reg_byte)) { - - addr_t first_operand; - addr_t second_operand; - struct cr0_real *real_cr0; - struct cr0_real *new_cr0; - operand_type_t addr_type; - char new_cr0_val = 0; - // LMSW - // decode mod/RM - index += 2; - - real_cr0 = (struct cr0_real*)&(info->ctrl_regs.cr0); + if (v3_decode(info, (addr_t)instr, &dec_instr) == -1) { + PrintError("Could not decode instruction\n"); + return -1; + } - addr_type = decode_operands16(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG16); + if (opcode_cmp(V3_OPCODE_LMSW, (const uchar_t *)(dec_instr.opcode)) == 0) { + struct cr0_real *real_cr0 = (struct cr0_real*)&(info->ctrl_regs.cr0); + struct cr0_real *new_cr0 = (struct cr0_real *)(dec_instr.first_operand.operand); + uchar_t new_cr0_val; - if (addr_type == REG_OPERAND) { - new_cr0 = (struct cr0_real *)first_operand; - } else if (addr_type == MEM_OPERAND) { - addr_t host_addr; + PrintDebug("LMSW\n"); - if (guest_pa_to_host_va(info, first_operand + (info->segments.ds.base << 4), &host_addr) == -1) { - // gpf the guest - return -1; - } + new_cr0_val = (*(char*)(new_cr0)) & 0x0f; + + PrintDebug("OperandVal = %x\n", new_cr0_val); - new_cr0 = (struct cr0_real *)host_addr; - } else { - // error... don't know what to do - return -1; - } - - if ((new_cr0->pe == 1) && (real_cr0->pe == 0)) { - info->cpu_mode = PROTECTED; - } else if ((new_cr0->pe == 0) && (real_cr0->pe == 1)) { - info->cpu_mode = REAL; - } + PrintDebug("Old CR0=%x\n", *real_cr0); + *(uchar_t*)real_cr0 &= 0xf0; + *(uchar_t*)real_cr0 |= new_cr0_val; + PrintDebug("New CR0=%x\n", *real_cr0); - new_cr0_val = *(char*)(new_cr0) & 0x0f; + if (info->shdw_pg_mode == SHADOW_PAGING) { + struct cr0_real * shadow_cr0 = (struct cr0_real*)&(info->shdw_pg_state.guest_cr0); + + PrintDebug(" Old Shadow CR0=%x\n", *shadow_cr0); + *(uchar_t*)shadow_cr0 &= 0xf0; + *(uchar_t*)shadow_cr0 |= new_cr0_val; + PrintDebug("New Shadow CR0=%x\n", *shadow_cr0); + } + } else if (opcode_cmp(V3_OPCODE_MOV2CR, (const uchar_t *)(dec_instr.opcode)) == 0) { + PrintDebug("MOV2CR0\n"); - if (info->page_mode == SHADOW_PAGING) { - struct cr0_real * shadow_cr0 = (struct cr0_real*)&(info->shdw_pg_state.guest_cr0); + if (info->cpu_mode == LONG) { + // 64 bit registers + } else { + // 32 bit registers + struct cr0_32 *real_cr0 = (struct cr0_32*)&(info->ctrl_regs.cr0); + struct cr0_32 *new_cr0= (struct cr0_32 *)(dec_instr.second_operand.operand); - 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 real_cr0 without worrying about the shadow fields - */ - *(char*)real_cr0 &= 0xf0; - *(char*)real_cr0 |= new_cr0_val; + PrintDebug("OperandVal = %x, length=%d\n", *new_cr0, dec_instr.first_operand.size); + + + PrintDebug("Old CR0=%x\n", *real_cr0); + *real_cr0 = *new_cr0; - *(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*)real_cr0 &= 0xf0; - *(char*)real_cr0 |= new_cr0_val; + if (info->shdw_pg_mode == SHADOW_PAGING) { + struct cr0_32 * shadow_cr0 = (struct cr0_32 *)&(info->shdw_pg_state.guest_cr0); + + PrintDebug("Old Shadow CR0=%x\n", *shadow_cr0); + + real_cr0->et = 1; + + *shadow_cr0 = *new_cr0; + shadow_cr0->et = 1; + + if (get_mem_mode(info) == VIRTUAL_MEM) { + struct cr3_32 * shadow_cr3 = (struct cr3_32 *)&(info->shdw_pg_state.shadow_cr3); + + info->ctrl_regs.cr3 = *(addr_t*)shadow_cr3; + } else { + info->ctrl_regs.cr3 = *(addr_t*)&(info->direct_map_pt); + real_cr0->pg = 1; + } + + PrintDebug("New Shadow CR0=%x\n",*shadow_cr0); + } + PrintDebug("New CR0=%x\n", *real_cr0); + } - PrintDebug("New CR0=%x\n", *real_cr0); - } + } else if (opcode_cmp(V3_OPCODE_CLTS, (const uchar_t *)(dec_instr.opcode)) == 0) { + // CLTS + struct cr0_32 *real_cr0 = (struct cr0_32*)&(info->ctrl_regs.cr0); + + real_cr0->ts = 0; + if (info->shdw_pg_mode == SHADOW_PAGING) { + struct cr0_32 * shadow_cr0 = (struct cr0_32 *)&(info->shdw_pg_state.guest_cr0); + shadow_cr0->ts = 0; + } + } - info->rip += index; + info->rip += dec_instr.instr_length; - } else if ((instr[index] == cr_access_byte) && - (instr[index + 1] == clts_byte)) { - // CLTS - PrintDebug("CLTS unhandled\n"); - return -1; + return 0; +} - } 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*)&(info->ctrl_regs.cr0); - addr_type = decode_operands16(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32); +int handle_cr0_read(struct guest_info * info) { + char instr[15]; - if (addr_type != REG_OPERAND) { - /* Mov to CR0 Can only be a 32 bit register */ - // FIX ME + switch (info->cpu_mode) { + + case REAL: + { + + int index = 0; + int ret; + + PrintDebug("Real Mode read from CR0 at linear guest pa 0x%x\n",get_addr_linear(info,info->rip,&(info->segments.cs))); + //PrintV3Segments(info); + + // 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); + if (ret != 15) { + // I think we should inject a GPF into the guest + PrintDebug("Could not read Real Mode instruction (ret=%d)\n", ret); return -1; } - new_cr0 = (struct cr0_32 *)first_operand; - if (new_cr0->pe == 1) { - PrintDebug("Entering Protected Mode\n"); - info->cpu_mode = PROTECTED; + while (is_prefix_byte(instr[index])) { + switch(instr[index]) { + case PREFIX_CS_OVERRIDE: + case PREFIX_SS_OVERRIDE: + case PREFIX_DS_OVERRIDE: + case PREFIX_ES_OVERRIDE: + case PREFIX_FS_OVERRIDE: + case PREFIX_GS_OVERRIDE: + PrintDebug("Segment Override!!\n"); + return -1; + break; + default: + break; + } + index++; } - if (new_cr0->pg == 1) { - // GPF the guest?? - return -1; - } + /* + while (is_prefix_byte(instr[index])) { + index++; + } + */ + + if ((instr[index] == cr_access_byte) && + (instr[index + 1] == smsw_byte) && + (MODRM_REG(instr[index + 2]) == smsw_reg_byte)) { - if (info->page_mode == SHADOW_PAGING) { - struct cr0_32 * shadow_cr0 = (struct cr0_32 *)&(info->shdw_pg_state.guest_cr0); + // SMSW (store machine status word) + + addr_t first_operand; + addr_t second_operand; + struct cr0_real *cr0; + operand_type_t addr_type; + char cr0_val = 0; + + index += 2; + + cr0 = (struct cr0_real*)&(info->ctrl_regs.cr0); + + + addr_type = decode_operands16(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG16); + + if (addr_type == MEM_OPERAND) { + addr_t host_addr; - PrintDebug("Old CR0=%x, Old Shadow CR0=%x\n", *real_cr0, *shadow_cr0); - *real_cr0 = *new_cr0; - real_cr0->pg = 1; + if (guest_pa_to_host_va(info, first_operand + (info->segments.ds.base << 4), &host_addr) == -1) { + // gpf the guest + PrintDebug("Could not convert guest physical address to host virtual address\n"); + return -1; + } + + first_operand = host_addr; + } else { + // Register operand + // Should be ok?? + } - *shadow_cr0 = *new_cr0; + cr0_val = *(char*)cr0 & 0x0f; - 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); - } + *(char *)first_operand &= 0xf0; + *(char *)first_operand |= cr0_val; - info->rip += index; + PrintDebug("index = %d, rip = %x\n", index, (ulong_t)(info->rip)); + info->rip += index; + PrintDebug("new_rip = %x\n", (ulong_t)(info->rip)); + // success - } else { - PrintDebug("Unsupported Instruction\n"); - // unsupported instruction, UD the guest - return -1; - } + } 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; + struct cr0_32 * real_cr0 = (struct cr0_32 *)&(info->ctrl_regs.cr0); - } else if (info->cpu_mode == PROTECTED) { - int index = 0; - int ret; + index += 2; - PrintDebug("Protected Mode write to CR0\n"); + 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; + } - // 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); - if (ret != 15) { - // I think we should inject a GPF into the guest - PrintDebug("Could not read instruction (ret=%d)\n", ret); - return -1; - } + if (info->shdw_pg_mode == SHADOW_PAGING) { + *virt_cr0 = *(struct cr0_32 *)&(info->shdw_pg_state.guest_cr0); + } else { + *virt_cr0 = *real_cr0; + } - while (is_prefix_byte(instr[index])) { - index++; - } + PrintDebug("Returning CR0: %x\n", *virt_cr0); - if ((instr[index] == cr_access_byte) && - (instr[index + 1] == mov_to_cr_byte)) { + info->rip += index; + + } else { + PrintDebug("Unknown read instr from CR0\n"); + return -1; + } + + } + + break; + + case PROTECTED: + { - addr_t first_operand; - addr_t second_operand; - struct cr0_32 *real_cr0; - struct cr0_32 *new_cr0; - operand_type_t addr_type; + int index = 0; + int ret; + + PrintDebug("Protected %s Mode read from CR0 at guest %s linear rip 0x%x\n", + 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 == 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); + } - index += 2; - - real_cr0 = (struct cr0_32*)&(info->ctrl_regs.cr0); - addr_type = decode_operands32(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32); + /* + PrintDebug("Instr (15 bytes) at %x:\n", instr); + PrintTraceMemDump((char*)instr, 15); + */ - if (addr_type != REG_OPERAND) { + 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 == VIRTUAL_MEM ? "Paged" : "", ret); return -1; } - new_cr0 = (struct cr0_32 *)first_operand; + while (is_prefix_byte(instr[index])) { + switch(instr[index]) { + case PREFIX_CS_OVERRIDE: + case PREFIX_SS_OVERRIDE: + case PREFIX_DS_OVERRIDE: + case PREFIX_ES_OVERRIDE: + case PREFIX_FS_OVERRIDE: + case PREFIX_GS_OVERRIDE: + PrintDebug("Segment Override!!\n"); + return -1; + break; + default: + break; + } + index++; + } - if (info->page_mode == SHADOW_PAGING) { - struct cr0_32 * shadow_cr0 = (struct cr0_32 *)&(info->shdw_pg_state.guest_cr0); - if (new_cr0->pg == 1){ - struct cr3_32 * shadow_cr3 = (struct cr3_32 *)&(info->shdw_pg_state.shadow_cr3); + /* + while (is_prefix_byte(instr[index])) { + index++; + } + */ - info->cpu_mode = PROTECTED_PG; - - *shadow_cr0 = *new_cr0; - *real_cr0 = *new_cr0; + if ((instr[index] == cr_access_byte) && + (instr[index+1] == mov_from_cr_byte)) { + + // MOV from CR0 to register - // - // Activate Shadow Paging - // - PrintDebug("Turning on paging in the guest\n"); + 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 *)&(info->ctrl_regs.cr0); - info->ctrl_regs.cr3 = *(addr_t*)shadow_cr3; - + index += 2; - } else if (new_cr0->pe == 0) { - info->cpu_mode = REAL; + addr_type = decode_operands32(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32); - *shadow_cr0 = *new_cr0; - *real_cr0 = *new_cr0; - real_cr0->pg = 1; + 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->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 + } + + } else { + *virt_cr0 = *real_cr0; + } - } else { - *real_cr0 = *new_cr0; - } + PrintDebug("real CR0: %x\n", *(uint_t*)real_cr0); + PrintDebug("returned CR0: %x\n", *(uint_t*)virt_cr0); + + info->rip += index; - info->rip += index; + } else { + PrintDebug("Unknown read instruction from CR0\n"); + return -1; + } } - - } else { - PrintDebug("Unknown Mode write to CR0\n"); + break; + + case PROTECTED_PAE: + PrintDebug("Protected PAE Mode read to CR0 is UNIMPLEMENTED\n"); + return -1; + + case LONG: + PrintDebug("Protected Long 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); + return -1; + } + break; } + + return 0; } -int handle_cr0_read(struct guest_info * info) { - char instr[15]; + +int handle_cr3_write(struct guest_info * info) { if (info->cpu_mode == REAL) { + // WHAT THE HELL DOES THIS EVEN MEAN????? + int index = 0; int ret; + char instr[15]; + + PrintDebug("Real Mode Write to CR3.\n"); + // 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 - // 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); + if (ret != 15) { - // I think we should inject a GPF into the guest - PrintDebug("Could not read Real Mode instruction (ret=%d)\n", ret); + PrintDebug("Could not read instruction (ret=%d)\n", ret); return -1; } - while (is_prefix_byte(instr[index])) { + switch(instr[index]) { + case PREFIX_CS_OVERRIDE: + case PREFIX_SS_OVERRIDE: + case PREFIX_DS_OVERRIDE: + case PREFIX_ES_OVERRIDE: + case PREFIX_FS_OVERRIDE: + case PREFIX_GS_OVERRIDE: + PrintDebug("Segment Override!!\n"); + return -1; + break; + default: + break; + } index++; } + if ((instr[index] == cr_access_byte) && - (instr[index + 1] == smsw_byte) && - (MODRM_REG(instr[index + 2]) == smsw_reg_byte)) { + (instr[index + 1] == mov_to_cr_byte)) { addr_t first_operand; addr_t second_operand; - struct cr0_real *cr0; + struct cr3_32 * new_cr3; + // struct cr3_32 * real_cr3; operand_type_t addr_type; - char cr0_val = 0; index += 2; - - cr0 = (struct cr0_real*)&(info->ctrl_regs.cr0); - - - addr_type = decode_operands16(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG16); - - if (addr_type == MEM_OPERAND) { - addr_t host_addr; - - if (guest_pa_to_host_va(info, first_operand + (info->segments.ds.base << 4), &host_addr) == -1) { - // gpf the guest - PrintDebug("Could not convert guest physical address to host virtual address\n"); - return -1; - } - - first_operand = host_addr; - } else { - // Register operand - // Should be ok?? + + addr_type = decode_operands16(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32); + + if (addr_type != REG_OPERAND) { + /* Mov to CR3 can only be a 32 bit register */ + return -1; } - cr0_val = *(char*)cr0 & 0x0f; + new_cr3 = (struct cr3_32 *)first_operand; - *(char *)first_operand &= 0xf0; - *(char *)first_operand |= cr0_val; + 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("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] == 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; + /* - struct cr0_32 * real_cr0 = (struct cr0_32 *)&(info->ctrl_regs.cr0); + if (CR3_TO_PDE32(*(uint_t*)shadow_cr3) != 0) { + PrintDebug("Shadow Page Table\n"); + PrintDebugPageTables((pde32_t *)CR3_TO_PDE32(*(uint_t*)shadow_cr3)); + } + */ - index += 2; + /* Delete the current Page Tables */ + delete_page_tables_pde32((pde32_t *)CR3_TO_PDE32(*(uint_t*)shadow_cr3)); - 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; - } + PrintDebug("Old Shadow CR3=%x; Old Guest CR3=%x\n", + *(uint_t*)shadow_cr3, *(uint_t*)guest_cr3); - 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; + *guest_cr3 = *new_cr3; - } else { - PrintDebug("Unknown read instr from CR0\n"); - return -1; - } - } else if (info->cpu_mode == PROTECTED) { - int index = 0; - int ret; - // 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); - if (ret != 15) { - // I think we should inject a GPF into the guest - PrintDebug("Could not read Proteced mode instruction (ret=%d)\n", ret); - return -1; - } + // Something like this + shadow_pt = create_new_shadow_pt32(info); + //shadow_pt = setup_shadow_pt32(info, CR3_TO_PDE32(*(addr_t *)new_cr3)); - while (is_prefix_byte(instr[index])) { - index++; - } + /* 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); - 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 *)&(info->ctrl_regs.cr0); + } + */ + + + shadow_cr3->pdt_base_addr = PD32_BASE_ADDR(shadow_pt); + + PrintDebug("New Shadow CR3=%x; New Guest CR3=%x\n", + *(uint_t*)shadow_cr3, *(uint_t*)guest_cr3); - 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"); + } else { + PrintDebug("Unknown Instruction\n"); + PrintTraceMemDump(instr,15); return -1; } - } else { - PrintDebug("Unknown mode read from CR0\n"); - return -1; - } - return 0; -} - - - - -int handle_cr3_write(struct guest_info * info) { - if ((info->cpu_mode == PROTECTED) || (info->cpu_mode == PROTECTED_PG)) { + } else 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; } - + while (is_prefix_byte(instr[index])) { - index++; + switch(instr[index]) { + case PREFIX_CS_OVERRIDE: + case PREFIX_SS_OVERRIDE: + case PREFIX_DS_OVERRIDE: + case PREFIX_ES_OVERRIDE: + case PREFIX_FS_OVERRIDE: + case PREFIX_GS_OVERRIDE: + PrintDebug("Segment Override!!\n"); + return -1; + break; + default: + break; + } + index++; } + + /* + while (is_prefix_byte(instr[index])) { + index++; + } + */ if ((instr[index] == cr_access_byte) && (instr[index + 1] == mov_to_cr_byte)) { @@ -445,27 +580,56 @@ 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); + + /* + 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(shadow_cr3)); + delete_page_tables_pde32((pde32_t *)CR3_TO_PDE32(*(uint_t*)shadow_cr3)); + + 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; } @@ -475,10 +639,11 @@ int handle_cr3_write(struct guest_info * info) { } else { PrintDebug("Unknown Instruction\n"); + PrintTraceMemDump(instr,15); return -1; } } else { - PrintDebug("Invalid operating Mode\n"); + PrintDebug("Invalid operating Mode (0x%x)\n", info->cpu_mode); return -1; } @@ -489,21 +654,123 @@ 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) { + char instr[15]; + int ret; + int index = 0; + 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); + + ret = read_guest_pa_memory(info, linear_addr, 15, instr); + + if (ret != 15) { + PrintDebug("Could not read instruction (ret=%d)\n", ret); + return -1; + } + + while (is_prefix_byte(instr[index])) { + switch(instr[index]) { + case PREFIX_CS_OVERRIDE: + case PREFIX_SS_OVERRIDE: + case PREFIX_DS_OVERRIDE: + case PREFIX_ES_OVERRIDE: + case PREFIX_FS_OVERRIDE: + case PREFIX_GS_OVERRIDE: + PrintDebug("Segment Override!!\n"); + return -1; + break; + default: + break; + } + index++; + } + + + if ((instr[index] == cr_access_byte) && + (instr[index + 1] == mov_from_cr_byte)) { + addr_t first_operand; + addr_t second_operand; + struct cr3_32 * virt_cr3; + struct cr3_32 * real_cr3 = (struct cr3_32 *)&(info->ctrl_regs.cr3); + operand_type_t addr_type; + + index += 2; + + addr_type = decode_operands16(&(info->vm_regs), instr + index, &index, &first_operand, &second_operand, REG32); + + if (addr_type != REG_OPERAND) { + /* Mov to CR3 can only be a 32 bit register */ + return -1; + } + + virt_cr3 = (struct cr3_32 *)first_operand; + + if (info->shdw_pg_mode == SHADOW_PAGING) { + *virt_cr3 = *(struct cr3_32 *)&(info->shdw_pg_state.guest_cr3); + } else { + *virt_cr3 = *real_cr3; + } + + info->rip += index; + } else { + PrintDebug("Unknown Instruction\n"); + PrintTraceMemDump(instr,15); + return -1; + } + + + return 0; + } 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; } while (is_prefix_byte(instr[index])) { - index++; + switch(instr[index]) { + case PREFIX_CS_OVERRIDE: + case PREFIX_SS_OVERRIDE: + case PREFIX_DS_OVERRIDE: + case PREFIX_ES_OVERRIDE: + case PREFIX_FS_OVERRIDE: + case PREFIX_GS_OVERRIDE: + PrintDebug("Segment Override!!\n"); + return -1; + break; + default: + break; + } + index++; } + /* + while (is_prefix_byte(instr[index])) { + index++; + } + */ + if ((instr[index] == cr_access_byte) && (instr[index + 1] == mov_from_cr_byte)) { addr_t first_operand; @@ -523,7 +790,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; @@ -532,10 +799,12 @@ int handle_cr3_read(struct guest_info * info) { info->rip += index; } else { PrintDebug("Unknown Instruction\n"); + PrintTraceMemDump(instr,15); return -1; } } else { - PrintDebug("Invalid operating Mode\n"); + PrintDebug("Invalid operating Mode (0x%x), control registers follow\n", info->cpu_mode); + PrintV3CtrlRegs(info); return -1; }