/* * Copyright (C) 2016 Veertu Inc, * Copyright (C) 2017 Google Inc, * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License as published by the Free Software Foundation; either * version 2 of the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public * License along with this program; if not, see . */ ///////////////////////////////////////////////////////////////////////// // // Copyright (C) 2001-2012 The Bochs Project // // This library is free software; you can redistribute it and/or // modify it under the terms of the GNU Lesser General Public // License as published by the Free Software Foundation; either // version 2 of the License, or (at your option) any later version. // // This library is distributed in the hope that it will be useful, // but WITHOUT ANY WARRANTY; without even the implied warranty of // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU // Lesser General Public License for more details. // // You should have received a copy of the GNU Lesser General Public // License along with this library; if not, write to the Free Software // Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA B 02110-1301 USA ///////////////////////////////////////////////////////////////////////// #include "qemu/osdep.h" #include "panic.h" #include "qemu-common.h" #include "x86_decode.h" #include "x86.h" #include "x86_emu.h" #include "x86_mmu.h" #include "x86_flags.h" #include "vmcs.h" #include "vmx.h" void hvf_handle_io(struct CPUState *cpu, uint16_t port, void *data, int direction, int size, uint32_t count); #define EXEC_2OP_FLAGS_CMD(env, decode, cmd, FLAGS_FUNC, save_res) \ { \ fetch_operands(env, decode, 2, true, true, false); \ switch (decode->operand_size) { \ case 1: \ { \ uint8_t v1 = (uint8_t)decode->op[0].val; \ uint8_t v2 = (uint8_t)decode->op[1].val; \ uint8_t diff = v1 cmd v2; \ if (save_res) { \ write_val_ext(env, decode->op[0].ptr, diff, 1); \ } \ FLAGS_FUNC##8(env, v1, v2, diff); \ break; \ } \ case 2: \ { \ uint16_t v1 = (uint16_t)decode->op[0].val; \ uint16_t v2 = (uint16_t)decode->op[1].val; \ uint16_t diff = v1 cmd v2; \ if (save_res) { \ write_val_ext(env, decode->op[0].ptr, diff, 2); \ } \ FLAGS_FUNC##16(env, v1, v2, diff); \ break; \ } \ case 4: \ { \ uint32_t v1 = (uint32_t)decode->op[0].val; \ uint32_t v2 = (uint32_t)decode->op[1].val; \ uint32_t diff = v1 cmd v2; \ if (save_res) { \ write_val_ext(env, decode->op[0].ptr, diff, 4); \ } \ FLAGS_FUNC##32(env, v1, v2, diff); \ break; \ } \ default: \ VM_PANIC("bad size\n"); \ } \ } \ target_ulong read_reg(CPUX86State *env, int reg, int size) { switch (size) { case 1: return x86_reg(env, reg)->lx; case 2: return x86_reg(env, reg)->rx; case 4: return x86_reg(env, reg)->erx; case 8: return x86_reg(env, reg)->rrx; default: abort(); } return 0; } void write_reg(CPUX86State *env, int reg, target_ulong val, int size) { switch (size) { case 1: x86_reg(env, reg)->lx = val; break; case 2: x86_reg(env, reg)->rx = val; break; case 4: x86_reg(env, reg)->rrx = (uint32_t)val; break; case 8: x86_reg(env, reg)->rrx = val; break; default: abort(); } } target_ulong read_val_from_reg(target_ulong reg_ptr, int size) { target_ulong val; switch (size) { case 1: val = *(uint8_t *)reg_ptr; break; case 2: val = *(uint16_t *)reg_ptr; break; case 4: val = *(uint32_t *)reg_ptr; break; case 8: val = *(uint64_t *)reg_ptr; break; default: abort(); } return val; } void write_val_to_reg(target_ulong reg_ptr, target_ulong val, int size) { switch (size) { case 1: *(uint8_t *)reg_ptr = val; break; case 2: *(uint16_t *)reg_ptr = val; break; case 4: *(uint64_t *)reg_ptr = (uint32_t)val; break; case 8: *(uint64_t *)reg_ptr = val; break; default: abort(); } } static bool is_host_reg(struct CPUX86State *env, target_ulong ptr) { return (ptr - (target_ulong)&env->regs[0]) < sizeof(env->regs); } void write_val_ext(struct CPUX86State *env, target_ulong ptr, target_ulong val, int size) { if (is_host_reg(env, ptr)) { write_val_to_reg(ptr, val, size); return; } vmx_write_mem(env_cpu(env), ptr, &val, size); } uint8_t *read_mmio(struct CPUX86State *env, target_ulong ptr, int bytes) { vmx_read_mem(env_cpu(env), env->hvf_mmio_buf, ptr, bytes); return env->hvf_mmio_buf; } target_ulong read_val_ext(struct CPUX86State *env, target_ulong ptr, int size) { target_ulong val; uint8_t *mmio_ptr; if (is_host_reg(env, ptr)) { return read_val_from_reg(ptr, size); } mmio_ptr = read_mmio(env, ptr, size); switch (size) { case 1: val = *(uint8_t *)mmio_ptr; break; case 2: val = *(uint16_t *)mmio_ptr; break; case 4: val = *(uint32_t *)mmio_ptr; break; case 8: val = *(uint64_t *)mmio_ptr; break; default: VM_PANIC("bad size\n"); break; } return val; } static void fetch_operands(struct CPUX86State *env, struct x86_decode *decode, int n, bool val_op0, bool val_op1, bool val_op2) { int i; bool calc_val[3] = {val_op0, val_op1, val_op2}; for (i = 0; i < n; i++) { switch (decode->op[i].type) { case X86_VAR_IMMEDIATE: break; case X86_VAR_REG: VM_PANIC_ON(!decode->op[i].ptr); if (calc_val[i]) { decode->op[i].val = read_val_from_reg(decode->op[i].ptr, decode->operand_size); } break; case X86_VAR_RM: calc_modrm_operand(env, decode, &decode->op[i]); if (calc_val[i]) { decode->op[i].val = read_val_ext(env, decode->op[i].ptr, decode->operand_size); } break; case X86_VAR_OFFSET: decode->op[i].ptr = decode_linear_addr(env, decode, decode->op[i].ptr, R_DS); if (calc_val[i]) { decode->op[i].val = read_val_ext(env, decode->op[i].ptr, decode->operand_size); } break; default: break; } } } static void exec_mov(struct CPUX86State *env, struct x86_decode *decode) { fetch_operands(env, decode, 2, false, true, false); write_val_ext(env, decode->op[0].ptr, decode->op[1].val, decode->operand_size); env->eip += decode->len; } static void exec_add(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, +, SET_FLAGS_OSZAPC_ADD, true); env->eip += decode->len; } static void exec_or(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, |, SET_FLAGS_OSZAPC_LOGIC, true); env->eip += decode->len; } static void exec_adc(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, +get_CF(env)+, SET_FLAGS_OSZAPC_ADD, true); env->eip += decode->len; } static void exec_sbb(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, -get_CF(env)-, SET_FLAGS_OSZAPC_SUB, true); env->eip += decode->len; } static void exec_and(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, &, SET_FLAGS_OSZAPC_LOGIC, true); env->eip += decode->len; } static void exec_sub(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, -, SET_FLAGS_OSZAPC_SUB, true); env->eip += decode->len; } static void exec_xor(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, ^, SET_FLAGS_OSZAPC_LOGIC, true); env->eip += decode->len; } static void exec_neg(struct CPUX86State *env, struct x86_decode *decode) { /*EXEC_2OP_FLAGS_CMD(env, decode, -, SET_FLAGS_OSZAPC_SUB, false);*/ int32_t val; fetch_operands(env, decode, 2, true, true, false); val = 0 - sign(decode->op[1].val, decode->operand_size); write_val_ext(env, decode->op[1].ptr, val, decode->operand_size); if (4 == decode->operand_size) { SET_FLAGS_OSZAPC_SUB32(env, 0, 0 - val, val); } else if (2 == decode->operand_size) { SET_FLAGS_OSZAPC_SUB16(env, 0, 0 - val, val); } else if (1 == decode->operand_size) { SET_FLAGS_OSZAPC_SUB8(env, 0, 0 - val, val); } else { VM_PANIC("bad op size\n"); } /*lflags_to_rflags(env);*/ env->eip += decode->len; } static void exec_cmp(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, -, SET_FLAGS_OSZAPC_SUB, false); env->eip += decode->len; } static void exec_inc(struct CPUX86State *env, struct x86_decode *decode) { decode->op[1].type = X86_VAR_IMMEDIATE; decode->op[1].val = 0; EXEC_2OP_FLAGS_CMD(env, decode, +1+, SET_FLAGS_OSZAP_ADD, true); env->eip += decode->len; } static void exec_dec(struct CPUX86State *env, struct x86_decode *decode) { decode->op[1].type = X86_VAR_IMMEDIATE; decode->op[1].val = 0; EXEC_2OP_FLAGS_CMD(env, decode, -1-, SET_FLAGS_OSZAP_SUB, true); env->eip += decode->len; } static void exec_tst(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, &, SET_FLAGS_OSZAPC_LOGIC, false); env->eip += decode->len; } static void exec_not(struct CPUX86State *env, struct x86_decode *decode) { fetch_operands(env, decode, 1, true, false, false); write_val_ext(env, decode->op[0].ptr, ~decode->op[0].val, decode->operand_size); env->eip += decode->len; } void exec_movzx(struct CPUX86State *env, struct x86_decode *decode) { int src_op_size; int op_size = decode->operand_size; fetch_operands(env, decode, 1, false, false, false); if (0xb6 == decode->opcode[1]) { src_op_size = 1; } else { src_op_size = 2; } decode->operand_size = src_op_size; calc_modrm_operand(env, decode, &decode->op[1]); decode->op[1].val = read_val_ext(env, decode->op[1].ptr, src_op_size); write_val_ext(env, decode->op[0].ptr, decode->op[1].val, op_size); env->eip += decode->len; } static void exec_out(struct CPUX86State *env, struct x86_decode *decode) { switch (decode->opcode[0]) { case 0xe6: hvf_handle_io(env_cpu(env), decode->op[0].val, &AL(env), 1, 1, 1); break; case 0xe7: hvf_handle_io(env_cpu(env), decode->op[0].val, &RAX(env), 1, decode->operand_size, 1); break; case 0xee: hvf_handle_io(env_cpu(env), DX(env), &AL(env), 1, 1, 1); break; case 0xef: hvf_handle_io(env_cpu(env), DX(env), &RAX(env), 1, decode->operand_size, 1); break; default: VM_PANIC("Bad out opcode\n"); break; } env->eip += decode->len; } static void exec_in(struct CPUX86State *env, struct x86_decode *decode) { target_ulong val = 0; switch (decode->opcode[0]) { case 0xe4: hvf_handle_io(env_cpu(env), decode->op[0].val, &AL(env), 0, 1, 1); break; case 0xe5: hvf_handle_io(env_cpu(env), decode->op[0].val, &val, 0, decode->operand_size, 1); if (decode->operand_size == 2) { AX(env) = val; } else { RAX(env) = (uint32_t)val; } break; case 0xec: hvf_handle_io(env_cpu(env), DX(env), &AL(env), 0, 1, 1); break; case 0xed: hvf_handle_io(env_cpu(env), DX(env), &val, 0, decode->operand_size, 1); if (decode->operand_size == 2) { AX(env) = val; } else { RAX(env) = (uint32_t)val; } break; default: VM_PANIC("Bad in opcode\n"); break; } env->eip += decode->len; } static inline void string_increment_reg(struct CPUX86State *env, int reg, struct x86_decode *decode) { target_ulong val = read_reg(env, reg, decode->addressing_size); if (env->eflags & DF_MASK) { val -= decode->operand_size; } else { val += decode->operand_size; } write_reg(env, reg, val, decode->addressing_size); } static inline void string_rep(struct CPUX86State *env, struct x86_decode *decode, void (*func)(struct CPUX86State *env, struct x86_decode *ins), int rep) { target_ulong rcx = read_reg(env, R_ECX, decode->addressing_size); while (rcx--) { func(env, decode); write_reg(env, R_ECX, rcx, decode->addressing_size); if ((PREFIX_REP == rep) && !get_ZF(env)) { break; } if ((PREFIX_REPN == rep) && get_ZF(env)) { break; } } } static void exec_ins_single(struct CPUX86State *env, struct x86_decode *decode) { target_ulong addr = linear_addr_size(env_cpu(env), RDI(env), decode->addressing_size, R_ES); hvf_handle_io(env_cpu(env), DX(env), env->hvf_mmio_buf, 0, decode->operand_size, 1); vmx_write_mem(env_cpu(env), addr, env->hvf_mmio_buf, decode->operand_size); string_increment_reg(env, R_EDI, decode); } static void exec_ins(struct CPUX86State *env, struct x86_decode *decode) { if (decode->rep) { string_rep(env, decode, exec_ins_single, 0); } else { exec_ins_single(env, decode); } env->eip += decode->len; } static void exec_outs_single(struct CPUX86State *env, struct x86_decode *decode) { target_ulong addr = decode_linear_addr(env, decode, RSI(env), R_DS); vmx_read_mem(env_cpu(env), env->hvf_mmio_buf, addr, decode->operand_size); hvf_handle_io(env_cpu(env), DX(env), env->hvf_mmio_buf, 1, decode->operand_size, 1); string_increment_reg(env, R_ESI, decode); } static void exec_outs(struct CPUX86State *env, struct x86_decode *decode) { if (decode->rep) { string_rep(env, decode, exec_outs_single, 0); } else { exec_outs_single(env, decode); } env->eip += decode->len; } static void exec_movs_single(struct CPUX86State *env, struct x86_decode *decode) { target_ulong src_addr; target_ulong dst_addr; target_ulong val; src_addr = decode_linear_addr(env, decode, RSI(env), R_DS); dst_addr = linear_addr_size(env_cpu(env), RDI(env), decode->addressing_size, R_ES); val = read_val_ext(env, src_addr, decode->operand_size); write_val_ext(env, dst_addr, val, decode->operand_size); string_increment_reg(env, R_ESI, decode); string_increment_reg(env, R_EDI, decode); } static void exec_movs(struct CPUX86State *env, struct x86_decode *decode) { if (decode->rep) { string_rep(env, decode, exec_movs_single, 0); } else { exec_movs_single(env, decode); } env->eip += decode->len; } static void exec_cmps_single(struct CPUX86State *env, struct x86_decode *decode) { target_ulong src_addr; target_ulong dst_addr; src_addr = decode_linear_addr(env, decode, RSI(env), R_DS); dst_addr = linear_addr_size(env_cpu(env), RDI(env), decode->addressing_size, R_ES); decode->op[0].type = X86_VAR_IMMEDIATE; decode->op[0].val = read_val_ext(env, src_addr, decode->operand_size); decode->op[1].type = X86_VAR_IMMEDIATE; decode->op[1].val = read_val_ext(env, dst_addr, decode->operand_size); EXEC_2OP_FLAGS_CMD(env, decode, -, SET_FLAGS_OSZAPC_SUB, false); string_increment_reg(env, R_ESI, decode); string_increment_reg(env, R_EDI, decode); } static void exec_cmps(struct CPUX86State *env, struct x86_decode *decode) { if (decode->rep) { string_rep(env, decode, exec_cmps_single, decode->rep); } else { exec_cmps_single(env, decode); } env->eip += decode->len; } static void exec_stos_single(struct CPUX86State *env, struct x86_decode *decode) { target_ulong addr; target_ulong val; addr = linear_addr_size(env_cpu(env), RDI(env), decode->addressing_size, R_ES); val = read_reg(env, R_EAX, decode->operand_size); vmx_write_mem(env_cpu(env), addr, &val, decode->operand_size); string_increment_reg(env, R_EDI, decode); } static void exec_stos(struct CPUX86State *env, struct x86_decode *decode) { if (decode->rep) { string_rep(env, decode, exec_stos_single, 0); } else { exec_stos_single(env, decode); } env->eip += decode->len; } static void exec_scas_single(struct CPUX86State *env, struct x86_decode *decode) { target_ulong addr; addr = linear_addr_size(env_cpu(env), RDI(env), decode->addressing_size, R_ES); decode->op[1].type = X86_VAR_IMMEDIATE; vmx_read_mem(env_cpu(env), &decode->op[1].val, addr, decode->operand_size); EXEC_2OP_FLAGS_CMD(env, decode, -, SET_FLAGS_OSZAPC_SUB, false); string_increment_reg(env, R_EDI, decode); } static void exec_scas(struct CPUX86State *env, struct x86_decode *decode) { decode->op[0].type = X86_VAR_REG; decode->op[0].reg = R_EAX; if (decode->rep) { string_rep(env, decode, exec_scas_single, decode->rep); } else { exec_scas_single(env, decode); } env->eip += decode->len; } static void exec_lods_single(struct CPUX86State *env, struct x86_decode *decode) { target_ulong addr; target_ulong val = 0; addr = decode_linear_addr(env, decode, RSI(env), R_DS); vmx_read_mem(env_cpu(env), &val, addr, decode->operand_size); write_reg(env, R_EAX, val, decode->operand_size); string_increment_reg(env, R_ESI, decode); } static void exec_lods(struct CPUX86State *env, struct x86_decode *decode) { if (decode->rep) { string_rep(env, decode, exec_lods_single, 0); } else { exec_lods_single(env, decode); } env->eip += decode->len; } void simulate_rdmsr(struct CPUState *cpu) { X86CPU *x86_cpu = X86_CPU(cpu); CPUX86State *env = &x86_cpu->env; uint32_t msr = ECX(env); uint64_t val = 0; switch (msr) { case MSR_IA32_TSC: val = rdtscp() + rvmcs(cpu->hvf_fd, VMCS_TSC_OFFSET); break; case MSR_IA32_APICBASE: val = cpu_get_apic_base(X86_CPU(cpu)->apic_state); break; case MSR_IA32_UCODE_REV: val = x86_cpu->ucode_rev; break; case MSR_EFER: val = rvmcs(cpu->hvf_fd, VMCS_GUEST_IA32_EFER); break; case MSR_FSBASE: val = rvmcs(cpu->hvf_fd, VMCS_GUEST_FS_BASE); break; case MSR_GSBASE: val = rvmcs(cpu->hvf_fd, VMCS_GUEST_GS_BASE); break; case MSR_KERNELGSBASE: val = rvmcs(cpu->hvf_fd, VMCS_HOST_FS_BASE); break; case MSR_STAR: abort(); break; case MSR_LSTAR: abort(); break; case MSR_CSTAR: abort(); break; case MSR_IA32_MISC_ENABLE: val = env->msr_ia32_misc_enable; break; case MSR_MTRRphysBase(0): case MSR_MTRRphysBase(1): case MSR_MTRRphysBase(2): case MSR_MTRRphysBase(3): case MSR_MTRRphysBase(4): case MSR_MTRRphysBase(5): case MSR_MTRRphysBase(6): case MSR_MTRRphysBase(7): val = env->mtrr_var[(ECX(env) - MSR_MTRRphysBase(0)) / 2].base; break; case MSR_MTRRphysMask(0): case MSR_MTRRphysMask(1): case MSR_MTRRphysMask(2): case MSR_MTRRphysMask(3): case MSR_MTRRphysMask(4): case MSR_MTRRphysMask(5): case MSR_MTRRphysMask(6): case MSR_MTRRphysMask(7): val = env->mtrr_var[(ECX(env) - MSR_MTRRphysMask(0)) / 2].mask; break; case MSR_MTRRfix64K_00000: val = env->mtrr_fixed[0]; break; case MSR_MTRRfix16K_80000: case MSR_MTRRfix16K_A0000: val = env->mtrr_fixed[ECX(env) - MSR_MTRRfix16K_80000 + 1]; break; case MSR_MTRRfix4K_C0000: case MSR_MTRRfix4K_C8000: case MSR_MTRRfix4K_D0000: case MSR_MTRRfix4K_D8000: case MSR_MTRRfix4K_E0000: case MSR_MTRRfix4K_E8000: case MSR_MTRRfix4K_F0000: case MSR_MTRRfix4K_F8000: val = env->mtrr_fixed[ECX(env) - MSR_MTRRfix4K_C0000 + 3]; break; case MSR_MTRRdefType: val = env->mtrr_deftype; break; default: /* fprintf(stderr, "%s: unknown msr 0x%x\n", __func__, msr); */ val = 0; break; } RAX(env) = (uint32_t)val; RDX(env) = (uint32_t)(val >> 32); } static void exec_rdmsr(struct CPUX86State *env, struct x86_decode *decode) { simulate_rdmsr(env_cpu(env)); env->eip += decode->len; } void simulate_wrmsr(struct CPUState *cpu) { X86CPU *x86_cpu = X86_CPU(cpu); CPUX86State *env = &x86_cpu->env; uint32_t msr = ECX(env); uint64_t data = ((uint64_t)EDX(env) << 32) | EAX(env); switch (msr) { case MSR_IA32_TSC: break; case MSR_IA32_APICBASE: cpu_set_apic_base(X86_CPU(cpu)->apic_state, data); break; case MSR_FSBASE: wvmcs(cpu->hvf_fd, VMCS_GUEST_FS_BASE, data); break; case MSR_GSBASE: wvmcs(cpu->hvf_fd, VMCS_GUEST_GS_BASE, data); break; case MSR_KERNELGSBASE: wvmcs(cpu->hvf_fd, VMCS_HOST_FS_BASE, data); break; case MSR_STAR: abort(); break; case MSR_LSTAR: abort(); break; case MSR_CSTAR: abort(); break; case MSR_EFER: /*printf("new efer %llx\n", EFER(cpu));*/ wvmcs(cpu->hvf_fd, VMCS_GUEST_IA32_EFER, data); if (data & MSR_EFER_NXE) { hv_vcpu_invalidate_tlb(cpu->hvf_fd); } break; case MSR_MTRRphysBase(0): case MSR_MTRRphysBase(1): case MSR_MTRRphysBase(2): case MSR_MTRRphysBase(3): case MSR_MTRRphysBase(4): case MSR_MTRRphysBase(5): case MSR_MTRRphysBase(6): case MSR_MTRRphysBase(7): env->mtrr_var[(ECX(env) - MSR_MTRRphysBase(0)) / 2].base = data; break; case MSR_MTRRphysMask(0): case MSR_MTRRphysMask(1): case MSR_MTRRphysMask(2): case MSR_MTRRphysMask(3): case MSR_MTRRphysMask(4): case MSR_MTRRphysMask(5): case MSR_MTRRphysMask(6): case MSR_MTRRphysMask(7): env->mtrr_var[(ECX(env) - MSR_MTRRphysMask(0)) / 2].mask = data; break; case MSR_MTRRfix64K_00000: env->mtrr_fixed[ECX(env) - MSR_MTRRfix64K_00000] = data; break; case MSR_MTRRfix16K_80000: case MSR_MTRRfix16K_A0000: env->mtrr_fixed[ECX(env) - MSR_MTRRfix16K_80000 + 1] = data; break; case MSR_MTRRfix4K_C0000: case MSR_MTRRfix4K_C8000: case MSR_MTRRfix4K_D0000: case MSR_MTRRfix4K_D8000: case MSR_MTRRfix4K_E0000: case MSR_MTRRfix4K_E8000: case MSR_MTRRfix4K_F0000: case MSR_MTRRfix4K_F8000: env->mtrr_fixed[ECX(env) - MSR_MTRRfix4K_C0000 + 3] = data; break; case MSR_MTRRdefType: env->mtrr_deftype = data; break; default: break; } /* Related to support known hypervisor interface */ /* if (g_hypervisor_iface) g_hypervisor_iface->wrmsr_handler(cpu, msr, data); printf("write msr %llx\n", RCX(cpu));*/ } static void exec_wrmsr(struct CPUX86State *env, struct x86_decode *decode) { simulate_wrmsr(env_cpu(env)); env->eip += decode->len; } /* * flag: * 0 - bt, 1 - btc, 2 - bts, 3 - btr */ static void do_bt(struct CPUX86State *env, struct x86_decode *decode, int flag) { int32_t displacement; uint8_t index; bool cf; int mask = (4 == decode->operand_size) ? 0x1f : 0xf; VM_PANIC_ON(decode->rex.rex); fetch_operands(env, decode, 2, false, true, false); index = decode->op[1].val & mask; if (decode->op[0].type != X86_VAR_REG) { if (4 == decode->operand_size) { displacement = ((int32_t) (decode->op[1].val & 0xffffffe0)) / 32; decode->op[0].ptr += 4 * displacement; } else if (2 == decode->operand_size) { displacement = ((int16_t) (decode->op[1].val & 0xfff0)) / 16; decode->op[0].ptr += 2 * displacement; } else { VM_PANIC("bt 64bit\n"); } } decode->op[0].val = read_val_ext(env, decode->op[0].ptr, decode->operand_size); cf = (decode->op[0].val >> index) & 0x01; switch (flag) { case 0: set_CF(env, cf); return; case 1: decode->op[0].val ^= (1u << index); break; case 2: decode->op[0].val |= (1u << index); break; case 3: decode->op[0].val &= ~(1u << index); break; } write_val_ext(env, decode->op[0].ptr, decode->op[0].val, decode->operand_size); set_CF(env, cf); } static void exec_bt(struct CPUX86State *env, struct x86_decode *decode) { do_bt(env, decode, 0); env->eip += decode->len; } static void exec_btc(struct CPUX86State *env, struct x86_decode *decode) { do_bt(env, decode, 1); env->eip += decode->len; } static void exec_btr(struct CPUX86State *env, struct x86_decode *decode) { do_bt(env, decode, 3); env->eip += decode->len; } static void exec_bts(struct CPUX86State *env, struct x86_decode *decode) { do_bt(env, decode, 2); env->eip += decode->len; } void exec_shl(struct CPUX86State *env, struct x86_decode *decode) { uint8_t count; int of = 0, cf = 0; fetch_operands(env, decode, 2, true, true, false); count = decode->op[1].val; count &= 0x1f; /* count is masked to 5 bits*/ if (!count) { goto exit; } switch (decode->operand_size) { case 1: { uint8_t res = 0; if (count <= 8) { res = (decode->op[0].val << count); cf = (decode->op[0].val >> (8 - count)) & 0x1; of = cf ^ (res >> 7); } write_val_ext(env, decode->op[0].ptr, res, 1); SET_FLAGS_OSZAPC_LOGIC8(env, 0, 0, res); SET_FLAGS_OxxxxC(env, of, cf); break; } case 2: { uint16_t res = 0; /* from bochs */ if (count <= 16) { res = (decode->op[0].val << count); cf = (decode->op[0].val >> (16 - count)) & 0x1; of = cf ^ (res >> 15); /* of = cf ^ result15 */ } write_val_ext(env, decode->op[0].ptr, res, 2); SET_FLAGS_OSZAPC_LOGIC16(env, 0, 0, res); SET_FLAGS_OxxxxC(env, of, cf); break; } case 4: { uint32_t res = decode->op[0].val << count; write_val_ext(env, decode->op[0].ptr, res, 4); SET_FLAGS_OSZAPC_LOGIC32(env, 0, 0, res); cf = (decode->op[0].val >> (32 - count)) & 0x1; of = cf ^ (res >> 31); /* of = cf ^ result31 */ SET_FLAGS_OxxxxC(env, of, cf); break; } default: abort(); } exit: /* lflags_to_rflags(env); */ env->eip += decode->len; } void exec_movsx(CPUX86State *env, struct x86_decode *decode) { int src_op_size; int op_size = decode->operand_size; fetch_operands(env, decode, 2, false, false, false); if (0xbe == decode->opcode[1]) { src_op_size = 1; } else { src_op_size = 2; } decode->operand_size = src_op_size; calc_modrm_operand(env, decode, &decode->op[1]); decode->op[1].val = sign(read_val_ext(env, decode->op[1].ptr, src_op_size), src_op_size); write_val_ext(env, decode->op[0].ptr, decode->op[1].val, op_size); env->eip += decode->len; } void exec_ror(struct CPUX86State *env, struct x86_decode *decode) { uint8_t count; fetch_operands(env, decode, 2, true, true, false); count = decode->op[1].val; switch (decode->operand_size) { case 1: { uint32_t bit6, bit7; uint8_t res; if ((count & 0x07) == 0) { if (count & 0x18) { bit6 = ((uint8_t)decode->op[0].val >> 6) & 1; bit7 = ((uint8_t)decode->op[0].val >> 7) & 1; SET_FLAGS_OxxxxC(env, bit6 ^ bit7, bit7); } } else { count &= 0x7; /* use only bottom 3 bits */ res = ((uint8_t)decode->op[0].val >> count) | ((uint8_t)decode->op[0].val << (8 - count)); write_val_ext(env, decode->op[0].ptr, res, 1); bit6 = (res >> 6) & 1; bit7 = (res >> 7) & 1; /* set eflags: ROR count affects the following flags: C, O */ SET_FLAGS_OxxxxC(env, bit6 ^ bit7, bit7); } break; } case 2: { uint32_t bit14, bit15; uint16_t res; if ((count & 0x0f) == 0) { if (count & 0x10) { bit14 = ((uint16_t)decode->op[0].val >> 14) & 1; bit15 = ((uint16_t)decode->op[0].val >> 15) & 1; /* of = result14 ^ result15 */ SET_FLAGS_OxxxxC(env, bit14 ^ bit15, bit15); } } else { count &= 0x0f; /* use only 4 LSB's */ res = ((uint16_t)decode->op[0].val >> count) | ((uint16_t)decode->op[0].val << (16 - count)); write_val_ext(env, decode->op[0].ptr, res, 2); bit14 = (res >> 14) & 1; bit15 = (res >> 15) & 1; /* of = result14 ^ result15 */ SET_FLAGS_OxxxxC(env, bit14 ^ bit15, bit15); } break; } case 4: { uint32_t bit31, bit30; uint32_t res; count &= 0x1f; if (count) { res = ((uint32_t)decode->op[0].val >> count) | ((uint32_t)decode->op[0].val << (32 - count)); write_val_ext(env, decode->op[0].ptr, res, 4); bit31 = (res >> 31) & 1; bit30 = (res >> 30) & 1; /* of = result30 ^ result31 */ SET_FLAGS_OxxxxC(env, bit30 ^ bit31, bit31); } break; } } env->eip += decode->len; } void exec_rol(struct CPUX86State *env, struct x86_decode *decode) { uint8_t count; fetch_operands(env, decode, 2, true, true, false); count = decode->op[1].val; switch (decode->operand_size) { case 1: { uint32_t bit0, bit7; uint8_t res; if ((count & 0x07) == 0) { if (count & 0x18) { bit0 = ((uint8_t)decode->op[0].val & 1); bit7 = ((uint8_t)decode->op[0].val >> 7); SET_FLAGS_OxxxxC(env, bit0 ^ bit7, bit0); } } else { count &= 0x7; /* use only lowest 3 bits */ res = ((uint8_t)decode->op[0].val << count) | ((uint8_t)decode->op[0].val >> (8 - count)); write_val_ext(env, decode->op[0].ptr, res, 1); /* set eflags: * ROL count affects the following flags: C, O */ bit0 = (res & 1); bit7 = (res >> 7); SET_FLAGS_OxxxxC(env, bit0 ^ bit7, bit0); } break; } case 2: { uint32_t bit0, bit15; uint16_t res; if ((count & 0x0f) == 0) { if (count & 0x10) { bit0 = ((uint16_t)decode->op[0].val & 0x1); bit15 = ((uint16_t)decode->op[0].val >> 15); /* of = cf ^ result15 */ SET_FLAGS_OxxxxC(env, bit0 ^ bit15, bit0); } } else { count &= 0x0f; /* only use bottom 4 bits */ res = ((uint16_t)decode->op[0].val << count) | ((uint16_t)decode->op[0].val >> (16 - count)); write_val_ext(env, decode->op[0].ptr, res, 2); bit0 = (res & 0x1); bit15 = (res >> 15); /* of = cf ^ result15 */ SET_FLAGS_OxxxxC(env, bit0 ^ bit15, bit0); } break; } case 4: { uint32_t bit0, bit31; uint32_t res; count &= 0x1f; if (count) { res = ((uint32_t)decode->op[0].val << count) | ((uint32_t)decode->op[0].val >> (32 - count)); write_val_ext(env, decode->op[0].ptr, res, 4); bit0 = (res & 0x1); bit31 = (res >> 31); /* of = cf ^ result31 */ SET_FLAGS_OxxxxC(env, bit0 ^ bit31, bit0); } break; } } env->eip += decode->len; } void exec_rcl(struct CPUX86State *env, struct x86_decode *decode) { uint8_t count; int of = 0, cf = 0; fetch_operands(env, decode, 2, true, true, false); count = decode->op[1].val & 0x1f; switch (decode->operand_size) { case 1: { uint8_t op1_8 = decode->op[0].val; uint8_t res; count %= 9; if (!count) { break; } if (1 == count) { res = (op1_8 << 1) | get_CF(env); } else { res = (op1_8 << count) | (get_CF(env) << (count - 1)) | (op1_8 >> (9 - count)); } write_val_ext(env, decode->op[0].ptr, res, 1); cf = (op1_8 >> (8 - count)) & 0x01; of = cf ^ (res >> 7); /* of = cf ^ result7 */ SET_FLAGS_OxxxxC(env, of, cf); break; } case 2: { uint16_t res; uint16_t op1_16 = decode->op[0].val; count %= 17; if (!count) { break; } if (1 == count) { res = (op1_16 << 1) | get_CF(env); } else if (count == 16) { res = (get_CF(env) << 15) | (op1_16 >> 1); } else { /* 2..15 */ res = (op1_16 << count) | (get_CF(env) << (count - 1)) | (op1_16 >> (17 - count)); } write_val_ext(env, decode->op[0].ptr, res, 2); cf = (op1_16 >> (16 - count)) & 0x1; of = cf ^ (res >> 15); /* of = cf ^ result15 */ SET_FLAGS_OxxxxC(env, of, cf); break; } case 4: { uint32_t res; uint32_t op1_32 = decode->op[0].val; if (!count) { break; } if (1 == count) { res = (op1_32 << 1) | get_CF(env); } else { res = (op1_32 << count) | (get_CF(env) << (count - 1)) | (op1_32 >> (33 - count)); } write_val_ext(env, decode->op[0].ptr, res, 4); cf = (op1_32 >> (32 - count)) & 0x1; of = cf ^ (res >> 31); /* of = cf ^ result31 */ SET_FLAGS_OxxxxC(env, of, cf); break; } } env->eip += decode->len; } void exec_rcr(struct CPUX86State *env, struct x86_decode *decode) { uint8_t count; int of = 0, cf = 0; fetch_operands(env, decode, 2, true, true, false); count = decode->op[1].val & 0x1f; switch (decode->operand_size) { case 1: { uint8_t op1_8 = decode->op[0].val; uint8_t res; count %= 9; if (!count) { break; } res = (op1_8 >> count) | (get_CF(env) << (8 - count)) | (op1_8 << (9 - count)); write_val_ext(env, decode->op[0].ptr, res, 1); cf = (op1_8 >> (count - 1)) & 0x1; of = (((res << 1) ^ res) >> 7) & 0x1; /* of = result6 ^ result7 */ SET_FLAGS_OxxxxC(env, of, cf); break; } case 2: { uint16_t op1_16 = decode->op[0].val; uint16_t res; count %= 17; if (!count) { break; } res = (op1_16 >> count) | (get_CF(env) << (16 - count)) | (op1_16 << (17 - count)); write_val_ext(env, decode->op[0].ptr, res, 2); cf = (op1_16 >> (count - 1)) & 0x1; of = ((uint16_t)((res << 1) ^ res) >> 15) & 0x1; /* of = result15 ^ result14 */ SET_FLAGS_OxxxxC(env, of, cf); break; } case 4: { uint32_t res; uint32_t op1_32 = decode->op[0].val; if (!count) { break; } if (1 == count) { res = (op1_32 >> 1) | (get_CF(env) << 31); } else { res = (op1_32 >> count) | (get_CF(env) << (32 - count)) | (op1_32 << (33 - count)); } write_val_ext(env, decode->op[0].ptr, res, 4); cf = (op1_32 >> (count - 1)) & 0x1; of = ((res << 1) ^ res) >> 31; /* of = result30 ^ result31 */ SET_FLAGS_OxxxxC(env, of, cf); break; } } env->eip += decode->len; } static void exec_xchg(struct CPUX86State *env, struct x86_decode *decode) { fetch_operands(env, decode, 2, true, true, false); write_val_ext(env, decode->op[0].ptr, decode->op[1].val, decode->operand_size); write_val_ext(env, decode->op[1].ptr, decode->op[0].val, decode->operand_size); env->eip += decode->len; } static void exec_xadd(struct CPUX86State *env, struct x86_decode *decode) { EXEC_2OP_FLAGS_CMD(env, decode, +, SET_FLAGS_OSZAPC_ADD, true); write_val_ext(env, decode->op[1].ptr, decode->op[0].val, decode->operand_size); env->eip += decode->len; } static struct cmd_handler { enum x86_decode_cmd cmd; void (*handler)(struct CPUX86State *env, struct x86_decode *ins); } handlers[] = { {X86_DECODE_CMD_INVL, NULL,}, {X86_DECODE_CMD_MOV, exec_mov}, {X86_DECODE_CMD_ADD, exec_add}, {X86_DECODE_CMD_OR, exec_or}, {X86_DECODE_CMD_ADC, exec_adc}, {X86_DECODE_CMD_SBB, exec_sbb}, {X86_DECODE_CMD_AND, exec_and}, {X86_DECODE_CMD_SUB, exec_sub}, {X86_DECODE_CMD_NEG, exec_neg}, {X86_DECODE_CMD_XOR, exec_xor}, {X86_DECODE_CMD_CMP, exec_cmp}, {X86_DECODE_CMD_INC, exec_inc}, {X86_DECODE_CMD_DEC, exec_dec}, {X86_DECODE_CMD_TST, exec_tst}, {X86_DECODE_CMD_NOT, exec_not}, {X86_DECODE_CMD_MOVZX, exec_movzx}, {X86_DECODE_CMD_OUT, exec_out}, {X86_DECODE_CMD_IN, exec_in}, {X86_DECODE_CMD_INS, exec_ins}, {X86_DECODE_CMD_OUTS, exec_outs}, {X86_DECODE_CMD_RDMSR, exec_rdmsr}, {X86_DECODE_CMD_WRMSR, exec_wrmsr}, {X86_DECODE_CMD_BT, exec_bt}, {X86_DECODE_CMD_BTR, exec_btr}, {X86_DECODE_CMD_BTC, exec_btc}, {X86_DECODE_CMD_BTS, exec_bts}, {X86_DECODE_CMD_SHL, exec_shl}, {X86_DECODE_CMD_ROL, exec_rol}, {X86_DECODE_CMD_ROR, exec_ror}, {X86_DECODE_CMD_RCR, exec_rcr}, {X86_DECODE_CMD_RCL, exec_rcl}, /*{X86_DECODE_CMD_CPUID, exec_cpuid},*/ {X86_DECODE_CMD_MOVS, exec_movs}, {X86_DECODE_CMD_CMPS, exec_cmps}, {X86_DECODE_CMD_STOS, exec_stos}, {X86_DECODE_CMD_SCAS, exec_scas}, {X86_DECODE_CMD_LODS, exec_lods}, {X86_DECODE_CMD_MOVSX, exec_movsx}, {X86_DECODE_CMD_XCHG, exec_xchg}, {X86_DECODE_CMD_XADD, exec_xadd}, }; static struct cmd_handler _cmd_handler[X86_DECODE_CMD_LAST]; static void init_cmd_handler() { int i; for (i = 0; i < ARRAY_SIZE(handlers); i++) { _cmd_handler[handlers[i].cmd] = handlers[i]; } } void load_regs(struct CPUState *cpu) { X86CPU *x86_cpu = X86_CPU(cpu); CPUX86State *env = &x86_cpu->env; int i = 0; RRX(env, R_EAX) = rreg(cpu->hvf_fd, HV_X86_RAX); RRX(env, R_EBX) = rreg(cpu->hvf_fd, HV_X86_RBX); RRX(env, R_ECX) = rreg(cpu->hvf_fd, HV_X86_RCX); RRX(env, R_EDX) = rreg(cpu->hvf_fd, HV_X86_RDX); RRX(env, R_ESI) = rreg(cpu->hvf_fd, HV_X86_RSI); RRX(env, R_EDI) = rreg(cpu->hvf_fd, HV_X86_RDI); RRX(env, R_ESP) = rreg(cpu->hvf_fd, HV_X86_RSP); RRX(env, R_EBP) = rreg(cpu->hvf_fd, HV_X86_RBP); for (i = 8; i < 16; i++) { RRX(env, i) = rreg(cpu->hvf_fd, HV_X86_RAX + i); } env->eflags = rreg(cpu->hvf_fd, HV_X86_RFLAGS); rflags_to_lflags(env); env->eip = rreg(cpu->hvf_fd, HV_X86_RIP); } void store_regs(struct CPUState *cpu) { X86CPU *x86_cpu = X86_CPU(cpu); CPUX86State *env = &x86_cpu->env; int i = 0; wreg(cpu->hvf_fd, HV_X86_RAX, RAX(env)); wreg(cpu->hvf_fd, HV_X86_RBX, RBX(env)); wreg(cpu->hvf_fd, HV_X86_RCX, RCX(env)); wreg(cpu->hvf_fd, HV_X86_RDX, RDX(env)); wreg(cpu->hvf_fd, HV_X86_RSI, RSI(env)); wreg(cpu->hvf_fd, HV_X86_RDI, RDI(env)); wreg(cpu->hvf_fd, HV_X86_RBP, RBP(env)); wreg(cpu->hvf_fd, HV_X86_RSP, RSP(env)); for (i = 8; i < 16; i++) { wreg(cpu->hvf_fd, HV_X86_RAX + i, RRX(env, i)); } lflags_to_rflags(env); wreg(cpu->hvf_fd, HV_X86_RFLAGS, env->eflags); macvm_set_rip(cpu, env->eip); } bool exec_instruction(struct CPUX86State *env, struct x86_decode *ins) { /*if (hvf_vcpu_id(cpu)) printf("%d, %llx: exec_instruction %s\n", hvf_vcpu_id(cpu), env->eip, decode_cmd_to_string(ins->cmd));*/ if (!_cmd_handler[ins->cmd].handler) { printf("Unimplemented handler (%llx) for %d (%x %x) \n", env->eip, ins->cmd, ins->opcode[0], ins->opcode_len > 1 ? ins->opcode[1] : 0); env->eip += ins->len; return true; } _cmd_handler[ins->cmd].handler(env, ins); return true; } void init_emu() { init_cmd_handler(); }