Commit e4e03ded authored by Laurent Vivier's avatar Laurent Vivier Committed by Avi Kivity

KVM: x86 emulator: move all x86_emulate_memop() to a structure

Move all x86_emulate_memop() common variables between decode and execute to a
structure decode_cache.  This will help in later separating decode and
emulate.

            struct decode_cache {
                u8 twobyte;
                u8 b;
                u8 lock_prefix;
                u8 rep_prefix;
                u8 op_bytes;
                u8 ad_bytes;
                struct operand src;
                struct operand dst;
                unsigned long *override_base;
                unsigned int d;
                unsigned long regs[NR_VCPU_REGS];
                unsigned long eip;
                /* modrm */
                u8 modrm;
                u8 modrm_mod;
                u8 modrm_reg;
                u8 modrm_rm;
                u8 use_modrm_ea;
                unsigned long modrm_ea;
                unsigned long modrm_val;
           };
Signed-off-by: default avatarLaurent Vivier <Laurent.Vivier@bull.net>
Signed-off-by: default avatarAvi Kivity <avi@qumranet.com>
parent a7ddce3a
...@@ -222,13 +222,6 @@ static u16 twobyte_table[256] = { ...@@ -222,13 +222,6 @@ static u16 twobyte_table[256] = {
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
}; };
/* Type, address-of, and value of an instruction's operand. */
struct operand {
enum { OP_REG, OP_MEM, OP_IMM } type;
unsigned int bytes;
unsigned long val, orig_val, *ptr;
};
/* EFLAGS bit definitions. */ /* EFLAGS bit definitions. */
#define EFLG_OF (1<<11) #define EFLG_OF (1<<11)
#define EFLG_DF (1<<10) #define EFLG_DF (1<<10)
...@@ -431,24 +424,26 @@ struct operand { ...@@ -431,24 +424,26 @@ struct operand {
/* Access/update address held in a register, based on addressing mode. */ /* Access/update address held in a register, based on addressing mode. */
#define address_mask(reg) \ #define address_mask(reg) \
((ad_bytes == sizeof(unsigned long)) ? \ ((c->ad_bytes == sizeof(unsigned long)) ? \
(reg) : ((reg) & ((1UL << (ad_bytes << 3)) - 1))) (reg) : ((reg) & ((1UL << (c->ad_bytes << 3)) - 1)))
#define register_address(base, reg) \ #define register_address(base, reg) \
((base) + address_mask(reg)) ((base) + address_mask(reg))
#define register_address_increment(reg, inc) \ #define register_address_increment(reg, inc) \
do { \ do { \
/* signed type ensures sign extension to long */ \ /* signed type ensures sign extension to long */ \
int _inc = (inc); \ int _inc = (inc); \
if ( ad_bytes == sizeof(unsigned long) ) \ if (c->ad_bytes == sizeof(unsigned long)) \
(reg) += _inc; \ (reg) += _inc; \
else \ else \
(reg) = ((reg) & ~((1UL << (ad_bytes << 3)) - 1)) | \ (reg) = ((reg) & \
(((reg) + _inc) & ((1UL << (ad_bytes << 3)) - 1)); \ ~((1UL << (c->ad_bytes << 3)) - 1)) | \
(((reg) + _inc) & \
((1UL << (c->ad_bytes << 3)) - 1)); \
} while (0) } while (0)
#define JMP_REL(rel) \ #define JMP_REL(rel) \
do { \ do { \
register_address_increment(_eip, rel); \ register_address_increment(c->eip, rel); \
} while (0) } while (0)
/* /*
...@@ -524,39 +519,35 @@ static int test_cc(unsigned int condition, unsigned int flags) ...@@ -524,39 +519,35 @@ static int test_cc(unsigned int condition, unsigned int flags)
int int
x86_emulate_memop(struct x86_emulate_ctxt *ctxt, struct x86_emulate_ops *ops) x86_emulate_memop(struct x86_emulate_ctxt *ctxt, struct x86_emulate_ops *ops)
{ {
unsigned d; struct decode_cache *c = &ctxt->decode;
u8 b, sib, twobyte = 0, rex_prefix = 0; u8 sib, rex_prefix = 0;
u8 modrm, modrm_mod = 0, modrm_reg = 0, modrm_rm = 0; unsigned int i;
unsigned long *override_base = NULL;
unsigned int op_bytes, ad_bytes, lock_prefix = 0, rep_prefix = 0, i;
int rc = 0; int rc = 0;
struct operand src, dst;
unsigned long cr2 = ctxt->cr2; unsigned long cr2 = ctxt->cr2;
int mode = ctxt->mode; int mode = ctxt->mode;
unsigned long modrm_ea; int index_reg = 0, base_reg = 0, scale, rip_relative = 0;
int use_modrm_ea, index_reg = 0, base_reg = 0, scale, rip_relative = 0;
int no_wb = 0; int no_wb = 0;
u64 msr_data; u64 msr_data;
/* Shadow copy of register state. Committed on successful emulation. */ /* Shadow copy of register state. Committed on successful emulation. */
unsigned long _regs[NR_VCPU_REGS]; unsigned long _eflags = ctxt->eflags;
unsigned long _eip = ctxt->vcpu->rip, _eflags = ctxt->eflags;
unsigned long modrm_val = 0;
memcpy(_regs, ctxt->vcpu->regs, sizeof _regs); memset(c, 0, sizeof(struct decode_cache));
c->eip = ctxt->vcpu->rip;
memcpy(c->regs, ctxt->vcpu->regs, sizeof c->regs);
switch (mode) { switch (mode) {
case X86EMUL_MODE_REAL: case X86EMUL_MODE_REAL:
case X86EMUL_MODE_PROT16: case X86EMUL_MODE_PROT16:
op_bytes = ad_bytes = 2; c->op_bytes = c->ad_bytes = 2;
break; break;
case X86EMUL_MODE_PROT32: case X86EMUL_MODE_PROT32:
op_bytes = ad_bytes = 4; c->op_bytes = c->ad_bytes = 4;
break; break;
#ifdef CONFIG_X86_64 #ifdef CONFIG_X86_64
case X86EMUL_MODE_PROT64: case X86EMUL_MODE_PROT64:
op_bytes = 4; c->op_bytes = 4;
ad_bytes = 8; c->ad_bytes = 8;
break; break;
#endif #endif
default: default:
...@@ -565,40 +556,42 @@ x86_emulate_memop(struct x86_emulate_ctxt *ctxt, struct x86_emulate_ops *ops) ...@@ -565,40 +556,42 @@ x86_emulate_memop(struct x86_emulate_ctxt *ctxt, struct x86_emulate_ops *ops)
/* Legacy prefixes. */ /* Legacy prefixes. */
for (i = 0; i < 8; i++) { for (i = 0; i < 8; i++) {
switch (b = insn_fetch(u8, 1, _eip)) { switch (c->b = insn_fetch(u8, 1, c->eip)) {
case 0x66: /* operand-size override */ case 0x66: /* operand-size override */
op_bytes ^= 6; /* switch between 2/4 bytes */ c->op_bytes ^= 6; /* switch between 2/4 bytes */
break; break;
case 0x67: /* address-size override */ case 0x67: /* address-size override */
if (mode == X86EMUL_MODE_PROT64) if (mode == X86EMUL_MODE_PROT64)
ad_bytes ^= 12; /* switch between 4/8 bytes */ /* switch between 4/8 bytes */
c->ad_bytes ^= 12;
else else
ad_bytes ^= 6; /* switch between 2/4 bytes */ /* switch between 2/4 bytes */
c->ad_bytes ^= 6;
break; break;
case 0x2e: /* CS override */ case 0x2e: /* CS override */
override_base = &ctxt->cs_base; c->override_base = &ctxt->cs_base;
break; break;
case 0x3e: /* DS override */ case 0x3e: /* DS override */
override_base = &ctxt->ds_base; c->override_base = &ctxt->ds_base;
break; break;
case 0x26: /* ES override */ case 0x26: /* ES override */
override_base = &ctxt->es_base; c->override_base = &ctxt->es_base;
break; break;
case 0x64: /* FS override */ case 0x64: /* FS override */
override_base = &ctxt->fs_base; c->override_base = &ctxt->fs_base;
break; break;
case 0x65: /* GS override */ case 0x65: /* GS override */
override_base = &ctxt->gs_base; c->override_base = &ctxt->gs_base;
break; break;
case 0x36: /* SS override */ case 0x36: /* SS override */
override_base = &ctxt->ss_base; c->override_base = &ctxt->ss_base;
break; break;
case 0xf0: /* LOCK */ case 0xf0: /* LOCK */
lock_prefix = 1; c->lock_prefix = 1;
break; break;
case 0xf2: /* REPNE/REPNZ */ case 0xf2: /* REPNE/REPNZ */
case 0xf3: /* REP/REPE/REPZ */ case 0xf3: /* REP/REPE/REPZ */
rep_prefix = 1; c->rep_prefix = 1;
break; break;
default: default:
goto done_prefixes; goto done_prefixes;
...@@ -608,177 +601,182 @@ x86_emulate_memop(struct x86_emulate_ctxt *ctxt, struct x86_emulate_ops *ops) ...@@ -608,177 +601,182 @@ x86_emulate_memop(struct x86_emulate_ctxt *ctxt, struct x86_emulate_ops *ops)
done_prefixes: done_prefixes:
/* REX prefix. */ /* REX prefix. */
if ((mode == X86EMUL_MODE_PROT64) && ((b & 0xf0) == 0x40)) { if ((mode == X86EMUL_MODE_PROT64) && ((c->b & 0xf0) == 0x40)) {
rex_prefix = b; rex_prefix = c->b;
if (b & 8) if (c->b & 8)
op_bytes = 8; /* REX.W */ c->op_bytes = 8; /* REX.W */
modrm_reg = (b & 4) << 1; /* REX.R */ c->modrm_reg = (c->b & 4) << 1; /* REX.R */
index_reg = (b & 2) << 2; /* REX.X */ index_reg = (c->b & 2) << 2; /* REX.X */
modrm_rm = base_reg = (b & 1) << 3; /* REG.B */ c->modrm_rm = base_reg = (c->b & 1) << 3; /* REG.B */
b = insn_fetch(u8, 1, _eip); c->b = insn_fetch(u8, 1, c->eip);
} }
/* Opcode byte(s). */ /* Opcode byte(s). */
d = opcode_table[b]; c->d = opcode_table[c->b];
if (d == 0) { if (c->d == 0) {
/* Two-byte opcode? */ /* Two-byte opcode? */
if (b == 0x0f) { if (c->b == 0x0f) {
twobyte = 1; c->twobyte = 1;
b = insn_fetch(u8, 1, _eip); c->b = insn_fetch(u8, 1, c->eip);
d = twobyte_table[b]; c->d = twobyte_table[c->b];
} }
/* Unrecognised? */ /* Unrecognised? */
if (d == 0) if (c->d == 0)
goto cannot_emulate; goto cannot_emulate;
} }
/* ModRM and SIB bytes. */ /* ModRM and SIB bytes. */
if (d & ModRM) { if (c->d & ModRM) {
modrm = insn_fetch(u8, 1, _eip); c->modrm = insn_fetch(u8, 1, c->eip);
modrm_mod |= (modrm & 0xc0) >> 6; c->modrm_mod |= (c->modrm & 0xc0) >> 6;
modrm_reg |= (modrm & 0x38) >> 3; c->modrm_reg |= (c->modrm & 0x38) >> 3;
modrm_rm |= (modrm & 0x07); c->modrm_rm |= (c->modrm & 0x07);
modrm_ea = 0; c->modrm_ea = 0;
use_modrm_ea = 1; c->use_modrm_ea = 1;
if (modrm_mod == 3) { if (c->modrm_mod == 3) {
modrm_val = *(unsigned long *) c->modrm_val = *(unsigned long *)
decode_register(modrm_rm, _regs, d & ByteOp); decode_register(c->modrm_rm, c->regs, c->d & ByteOp);
goto modrm_done; goto modrm_done;
} }
if (ad_bytes == 2) { if (c->ad_bytes == 2) {
unsigned bx = _regs[VCPU_REGS_RBX]; unsigned bx = c->regs[VCPU_REGS_RBX];
unsigned bp = _regs[VCPU_REGS_RBP]; unsigned bp = c->regs[VCPU_REGS_RBP];
unsigned si = _regs[VCPU_REGS_RSI]; unsigned si = c->regs[VCPU_REGS_RSI];
unsigned di = _regs[VCPU_REGS_RDI]; unsigned di = c->regs[VCPU_REGS_RDI];
/* 16-bit ModR/M decode. */ /* 16-bit ModR/M decode. */
switch (modrm_mod) { switch (c->modrm_mod) {
case 0: case 0:
if (modrm_rm == 6) if (c->modrm_rm == 6)
modrm_ea += insn_fetch(u16, 2, _eip); c->modrm_ea +=
insn_fetch(u16, 2, c->eip);
break; break;
case 1: case 1:
modrm_ea += insn_fetch(s8, 1, _eip); c->modrm_ea += insn_fetch(s8, 1, c->eip);
break; break;
case 2: case 2:
modrm_ea += insn_fetch(u16, 2, _eip); c->modrm_ea += insn_fetch(u16, 2, c->eip);
break; break;
} }
switch (modrm_rm) { switch (c->modrm_rm) {
case 0: case 0:
modrm_ea += bx + si; c->modrm_ea += bx + si;
break; break;
case 1: case 1:
modrm_ea += bx + di; c->modrm_ea += bx + di;
break; break;
case 2: case 2:
modrm_ea += bp + si; c->modrm_ea += bp + si;
break; break;
case 3: case 3:
modrm_ea += bp + di; c->modrm_ea += bp + di;
break; break;
case 4: case 4:
modrm_ea += si; c->modrm_ea += si;
break; break;
case 5: case 5:
modrm_ea += di; c->modrm_ea += di;
break; break;
case 6: case 6:
if (modrm_mod != 0) if (c->modrm_mod != 0)
modrm_ea += bp; c->modrm_ea += bp;
break; break;
case 7: case 7:
modrm_ea += bx; c->modrm_ea += bx;
break; break;
} }
if (modrm_rm == 2 || modrm_rm == 3 || if (c->modrm_rm == 2 || c->modrm_rm == 3 ||
(modrm_rm == 6 && modrm_mod != 0)) (c->modrm_rm == 6 && c->modrm_mod != 0))
if (!override_base) if (!c->override_base)
override_base = &ctxt->ss_base; c->override_base = &ctxt->ss_base;
modrm_ea = (u16)modrm_ea; c->modrm_ea = (u16)c->modrm_ea;
} else { } else {
/* 32/64-bit ModR/M decode. */ /* 32/64-bit ModR/M decode. */
switch (modrm_rm) { switch (c->modrm_rm) {
case 4: case 4:
case 12: case 12:
sib = insn_fetch(u8, 1, _eip); sib = insn_fetch(u8, 1, c->eip);
index_reg |= (sib >> 3) & 7; index_reg |= (sib >> 3) & 7;
base_reg |= sib & 7; base_reg |= sib & 7;
scale = sib >> 6; scale = sib >> 6;
switch (base_reg) { switch (base_reg) {
case 5: case 5:
if (modrm_mod != 0) if (c->modrm_mod != 0)
modrm_ea += _regs[base_reg]; c->modrm_ea +=
c->regs[base_reg];
else else
modrm_ea += insn_fetch(s32, 4, _eip); c->modrm_ea +=
insn_fetch(s32, 4, c->eip);
break; break;
default: default:
modrm_ea += _regs[base_reg]; c->modrm_ea += c->regs[base_reg];
} }
switch (index_reg) { switch (index_reg) {
case 4: case 4:
break; break;
default: default:
modrm_ea += _regs[index_reg] << scale; c->modrm_ea +=
c->regs[index_reg] << scale;
} }
break; break;
case 5: case 5:
if (modrm_mod != 0) if (c->modrm_mod != 0)
modrm_ea += _regs[modrm_rm]; c->modrm_ea += c->regs[c->modrm_rm];
else if (mode == X86EMUL_MODE_PROT64) else if (mode == X86EMUL_MODE_PROT64)
rip_relative = 1; rip_relative = 1;
break; break;
default: default:
modrm_ea += _regs[modrm_rm]; c->modrm_ea += c->regs[c->modrm_rm];
break; break;
} }
switch (modrm_mod) { switch (c->modrm_mod) {
case 0: case 0:
if (modrm_rm == 5) if (c->modrm_rm == 5)
modrm_ea += insn_fetch(s32, 4, _eip); c->modrm_ea +=
insn_fetch(s32, 4, c->eip);
break; break;
case 1: case 1:
modrm_ea += insn_fetch(s8, 1, _eip); c->modrm_ea += insn_fetch(s8, 1, c->eip);
break; break;
case 2: case 2:
modrm_ea += insn_fetch(s32, 4, _eip); c->modrm_ea += insn_fetch(s32, 4, c->eip);
break; break;
} }
} }
if (!override_base) if (!c->override_base)
override_base = &ctxt->ds_base; c->override_base = &ctxt->ds_base;
if (mode == X86EMUL_MODE_PROT64 && if (mode == X86EMUL_MODE_PROT64 &&
override_base != &ctxt->fs_base && c->override_base != &ctxt->fs_base &&
override_base != &ctxt->gs_base) c->override_base != &ctxt->gs_base)
override_base = NULL; c->override_base = NULL;
if (override_base) if (c->override_base)
modrm_ea += *override_base; c->modrm_ea += *c->override_base;
if (rip_relative) { if (rip_relative) {
modrm_ea += _eip; c->modrm_ea += c->eip;
switch (d & SrcMask) { switch (c->d & SrcMask) {
case SrcImmByte: case SrcImmByte:
modrm_ea += 1; c->modrm_ea += 1;
break; break;
case SrcImm: case SrcImm:
if (d & ByteOp) if (c->d & ByteOp)
modrm_ea += 1; c->modrm_ea += 1;
else else
if (op_bytes == 8) if (c->op_bytes == 8)
modrm_ea += 4; c->modrm_ea += 4;
else else
modrm_ea += op_bytes; c->modrm_ea += c->op_bytes;
} }
} }
if (ad_bytes != 8) if (c->ad_bytes != 8)
modrm_ea = (u32)modrm_ea; c->modrm_ea = (u32)c->modrm_ea;
cr2 = modrm_ea; cr2 = c->modrm_ea;
modrm_done: modrm_done:
; ;
} }
...@@ -787,200 +785,210 @@ done_prefixes: ...@@ -787,200 +785,210 @@ done_prefixes:
* Decode and fetch the source operand: register, memory * Decode and fetch the source operand: register, memory
* or immediate. * or immediate.
*/ */
switch (d & SrcMask) { switch (c->d & SrcMask) {
case SrcNone: case SrcNone:
break; break;
case SrcReg: case SrcReg:
src.type = OP_REG; c->src.type = OP_REG;
if (d & ByteOp) { if (c->d & ByteOp) {
src.ptr = decode_register(modrm_reg, _regs, c->src.ptr =
decode_register(c->modrm_reg, c->regs,
(rex_prefix == 0)); (rex_prefix == 0));
src.val = src.orig_val = *(u8 *) src.ptr; c->src.val = c->src.orig_val = *(u8 *)c->src.ptr;
src.bytes = 1; c->src.bytes = 1;
} else { } else {
src.ptr = decode_register(modrm_reg, _regs, 0); c->src.ptr =
switch ((src.bytes = op_bytes)) { decode_register(c->modrm_reg, c->regs, 0);
switch ((c->src.bytes = c->op_bytes)) {
case 2: case 2:
src.val = src.orig_val = *(u16 *) src.ptr; c->src.val = c->src.orig_val =
*(u16 *) c->src.ptr;
break; break;
case 4: case 4:
src.val = src.orig_val = *(u32 *) src.ptr; c->src.val = c->src.orig_val =
*(u32 *) c->src.ptr;
break; break;
case 8: case 8:
src.val = src.orig_val = *(u64 *) src.ptr; c->src.val = c->src.orig_val =
*(u64 *) c->src.ptr;
break; break;
} }
} }
break; break;
case SrcMem16: case SrcMem16:
src.bytes = 2; c->src.bytes = 2;
goto srcmem_common; goto srcmem_common;
case SrcMem32: case SrcMem32:
src.bytes = 4; c->src.bytes = 4;
goto srcmem_common; goto srcmem_common;
case SrcMem: case SrcMem:
src.bytes = (d & ByteOp) ? 1 : op_bytes; c->src.bytes = (c->d & ByteOp) ? 1 :
c->op_bytes;
/* Don't fetch the address for invlpg: it could be unmapped. */ /* Don't fetch the address for invlpg: it could be unmapped. */
if (twobyte && b == 0x01 && modrm_reg == 7) if (c->twobyte && c->b == 0x01
&& c->modrm_reg == 7)
break; break;
srcmem_common: srcmem_common:
/* /*
* For instructions with a ModR/M byte, switch to register * For instructions with a ModR/M byte, switch to register
* access if Mod = 3. * access if Mod = 3.
*/ */
if ((d & ModRM) && modrm_mod == 3) { if ((c->d & ModRM) && c->modrm_mod == 3) {
src.type = OP_REG; c->src.type = OP_REG;
break; break;
} }
src.type = OP_MEM; c->src.type = OP_MEM;
src.ptr = (unsigned long *)cr2; c->src.ptr = (unsigned long *)cr2;
src.val = 0; c->src.val = 0;
if ((rc = ops->read_emulated((unsigned long)src.ptr, if ((rc = ops->read_emulated((unsigned long)c->src.ptr,
&src.val, src.bytes, ctxt->vcpu)) != 0) &c->src.val,
c->src.bytes, ctxt->vcpu)) != 0)
goto done; goto done;
src.orig_val = src.val; c->src.orig_val = c->src.val;
break; break;
case SrcImm: case SrcImm:
src.type = OP_IMM; c->src.type = OP_IMM;
src.ptr = (unsigned long *)_eip; c->src.ptr = (unsigned long *)c->eip;
src.bytes = (d & ByteOp) ? 1 : op_bytes; c->src.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
if (src.bytes == 8) if (c->src.bytes == 8)
src.bytes = 4; c->src.bytes = 4;
/* NB. Immediates are sign-extended as necessary. */ /* NB. Immediates are sign-extended as necessary. */
switch (src.bytes) { switch (c->src.bytes) {
case 1: case 1:
src.val = insn_fetch(s8, 1, _eip); c->src.val = insn_fetch(s8, 1, c->eip);
break; break;
case 2: case 2:
src.val = insn_fetch(s16, 2, _eip); c->src.val = insn_fetch(s16, 2, c->eip);
break; break;
case 4: case 4:
src.val = insn_fetch(s32, 4, _eip); c->src.val = insn_fetch(s32, 4, c->eip);
break; break;
} }
break; break;
case SrcImmByte: case SrcImmByte:
src.type = OP_IMM; c->src.type = OP_IMM;
src.ptr = (unsigned long *)_eip; c->src.ptr = (unsigned long *)c->eip;
src.bytes = 1; c->src.bytes = 1;
src.val = insn_fetch(s8, 1, _eip); c->src.val = insn_fetch(s8, 1, c->eip);
break; break;
} }
/* Decode and fetch the destination operand: register or memory. */ /* Decode and fetch the destination operand: register or memory. */
switch (d & DstMask) { switch (c->d & DstMask) {
case ImplicitOps: case ImplicitOps:
/* Special instructions do their own operand decoding. */ /* Special instructions do their own operand decoding. */
goto special_insn; goto special_insn;
case DstReg: case DstReg:
dst.type = OP_REG; c->dst.type = OP_REG;
if ((d & ByteOp) if ((c->d & ByteOp)
&& !(twobyte && (b == 0xb6 || b == 0xb7))) { && !(c->twobyte &&
dst.ptr = decode_register(modrm_reg, _regs, (c->b == 0xb6 || c->b == 0xb7))) {
c->dst.ptr =
decode_register(c->modrm_reg, c->regs,
(rex_prefix == 0)); (rex_prefix == 0));
dst.val = *(u8 *) dst.ptr; c->dst.val = *(u8 *) c->dst.ptr;
dst.bytes = 1; c->dst.bytes = 1;
} else { } else {
dst.ptr = decode_register(modrm_reg, _regs, 0); c->dst.ptr =
switch ((dst.bytes = op_bytes)) { decode_register(c->modrm_reg, c->regs, 0);
switch ((c->dst.bytes = c->op_bytes)) {
case 2: case 2:
dst.val = *(u16 *)dst.ptr; c->dst.val = *(u16 *)c->dst.ptr;
break; break;
case 4: case 4:
dst.val = *(u32 *)dst.ptr; c->dst.val = *(u32 *)c->dst.ptr;
break; break;
case 8: case 8:
dst.val = *(u64 *)dst.ptr; c->dst.val = *(u64 *)c->dst.ptr;
break; break;
} }
} }
break; break;
case DstMem: case DstMem:
dst.type = OP_MEM; c->dst.type = OP_MEM;
dst.ptr = (unsigned long *)cr2; c->dst.ptr = (unsigned long *)cr2;
dst.bytes = (d & ByteOp) ? 1 : op_bytes; c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
dst.val = 0; c->dst.val = 0;
/* if ((c->d & ModRM) && c->modrm_mod == 3) {
* For instructions with a ModR/M byte, switch to register c->dst.type = OP_REG;
* access if Mod = 3.
*/
if ((d & ModRM) && modrm_mod == 3) {
dst.type = OP_REG;
break; break;
} }
if (d & BitOp) { if (c->d & BitOp) {
unsigned long mask = ~(dst.bytes * 8 - 1); unsigned long mask = ~(c->dst.bytes * 8 - 1);
dst.ptr = (void *)dst.ptr + (src.val & mask) / 8; c->dst.ptr = (void *)c->dst.ptr +
(c->src.val & mask) / 8;
} }
if (!(d & Mov) && /* optimisation - avoid slow emulated read */ if (!(c->d & Mov) &&
((rc = ops->read_emulated((unsigned long)dst.ptr, /* optimisation - avoid slow emulated read */
&dst.val, dst.bytes, ctxt->vcpu)) != 0)) ((rc = ops->read_emulated((unsigned long)c->dst.ptr,
&c->dst.val,
c->dst.bytes, ctxt->vcpu)) != 0))
goto done; goto done;
break; break;
} }
dst.orig_val = dst.val; c->dst.orig_val = c->dst.val;
if (twobyte) if (c->twobyte)
goto twobyte_insn; goto twobyte_insn;
switch (b) { switch (c->b) {
case 0x00 ... 0x05: case 0x00 ... 0x05:
add: /* add */ add: /* add */
emulate_2op_SrcV("add", src, dst, _eflags); emulate_2op_SrcV("add", c->src, c->dst, _eflags);
break; break;
case 0x08 ... 0x0d: case 0x08 ... 0x0d:
or: /* or */ or: /* or */
emulate_2op_SrcV("or", src, dst, _eflags); emulate_2op_SrcV("or", c->src, c->dst, _eflags);
break; break;
case 0x10 ... 0x15: case 0x10 ... 0x15:
adc: /* adc */ adc: /* adc */
emulate_2op_SrcV("adc", src, dst, _eflags); emulate_2op_SrcV("adc", c->src, c->dst, _eflags);
break; break;
case 0x18 ... 0x1d: case 0x18 ... 0x1d:
sbb: /* sbb */ sbb: /* sbb */
emulate_2op_SrcV("sbb", src, dst, _eflags); emulate_2op_SrcV("sbb", c->src, c->dst, _eflags);
break; break;
case 0x20 ... 0x23: case 0x20 ... 0x23:
and: /* and */ and: /* and */
emulate_2op_SrcV("and", src, dst, _eflags); emulate_2op_SrcV("and", c->src, c->dst, _eflags);
break; break;
case 0x24: /* and al imm8 */ case 0x24: /* and al imm8 */
dst.type = OP_REG; c->dst.type = OP_REG;
dst.ptr = &_regs[VCPU_REGS_RAX]; c->dst.ptr = &c->regs[VCPU_REGS_RAX];
dst.val = *(u8 *)dst.ptr; c->dst.val = *(u8 *)c->dst.ptr;
dst.bytes = 1; c->dst.bytes = 1;
dst.orig_val = dst.val; c->dst.orig_val = c->dst.val;
goto and; goto and;
case 0x25: /* and ax imm16, or eax imm32 */ case 0x25: /* and ax imm16, or eax imm32 */
dst.type = OP_REG; c->dst.type = OP_REG;
dst.bytes = op_bytes; c->dst.bytes = c->op_bytes;
dst.ptr = &_regs[VCPU_REGS_RAX]; c->dst.ptr = &c->regs[VCPU_REGS_RAX];
if (op_bytes == 2) if (c->op_bytes == 2)
dst.val = *(u16 *)dst.ptr; c->dst.val = *(u16 *)c->dst.ptr;
else else
dst.val = *(u32 *)dst.ptr; c->dst.val = *(u32 *)c->dst.ptr;
dst.orig_val = dst.val; c->dst.orig_val = c->dst.val;
goto and; goto and;
case 0x28 ... 0x2d: case 0x28 ... 0x2d:
sub: /* sub */ sub: /* sub */
emulate_2op_SrcV("sub", src, dst, _eflags); emulate_2op_SrcV("sub", c->src, c->dst, _eflags);
break; break;
case 0x30 ... 0x35: case 0x30 ... 0x35:
xor: /* xor */ xor: /* xor */
emulate_2op_SrcV("xor", src, dst, _eflags); emulate_2op_SrcV("xor", c->src, c->dst, _eflags);
break; break;
case 0x38 ... 0x3d: case 0x38 ... 0x3d:
cmp: /* cmp */ cmp: /* cmp */
emulate_2op_SrcV("cmp", src, dst, _eflags); emulate_2op_SrcV("cmp", c->src, c->dst, _eflags);
break; break;
case 0x63: /* movsxd */ case 0x63: /* movsxd */
if (mode != X86EMUL_MODE_PROT64) if (mode != X86EMUL_MODE_PROT64)
goto cannot_emulate; goto cannot_emulate;
dst.val = (s32) src.val; c->dst.val = (s32) c->src.val;
break; break;
case 0x80 ... 0x83: /* Grp1 */ case 0x80 ... 0x83: /* Grp1 */
switch (modrm_reg) { switch (c->modrm_reg) {
case 0: case 0:
goto add; goto add;
case 1: case 1:
...@@ -1001,155 +1009,164 @@ done_prefixes: ...@@ -1001,155 +1009,164 @@ done_prefixes:
break; break;
case 0x84 ... 0x85: case 0x84 ... 0x85:
test: /* test */ test: /* test */
emulate_2op_SrcV("test", src, dst, _eflags); emulate_2op_SrcV("test", c->src, c->dst, _eflags);
break; break;
case 0x86 ... 0x87: /* xchg */ case 0x86 ... 0x87: /* xchg */
/* Write back the register source. */ /* Write back the register source. */
switch (dst.bytes) { switch (c->dst.bytes) {
case 1: case 1:
*(u8 *) src.ptr = (u8) dst.val; *(u8 *) c->src.ptr = (u8) c->dst.val;
break; break;
case 2: case 2:
*(u16 *) src.ptr = (u16) dst.val; *(u16 *) c->src.ptr = (u16) c->dst.val;
break; break;
case 4: case 4:
*src.ptr = (u32) dst.val; *c->src.ptr = (u32) c->dst.val;
break; /* 64b reg: zero-extend */ break; /* 64b reg: zero-extend */
case 8: case 8:
*src.ptr = dst.val; *c->src.ptr = c->dst.val;
break; break;
} }
/* /*
* Write back the memory destination with implicit LOCK * Write back the memory destination with implicit LOCK
* prefix. * prefix.
*/ */
dst.val = src.val; c->dst.val = c->src.val;
lock_prefix = 1; c->lock_prefix = 1;
break; break;
case 0x88 ... 0x8b: /* mov */ case 0x88 ... 0x8b: /* mov */
goto mov; goto mov;
case 0x8d: /* lea r16/r32, m */ case 0x8d: /* lea r16/r32, m */
dst.val = modrm_val; c->dst.val = c->modrm_val;
break; break;
case 0x8f: /* pop (sole member of Grp1a) */ case 0x8f: /* pop (sole member of Grp1a) */
/* 64-bit mode: POP always pops a 64-bit operand. */ /* 64-bit mode: POP always pops a 64-bit operand. */
if (mode == X86EMUL_MODE_PROT64) if (mode == X86EMUL_MODE_PROT64)
dst.bytes = 8; c->dst.bytes = 8;
if ((rc = ops->read_std(register_address(ctxt->ss_base, if ((rc = ops->read_std(register_address(
_regs[VCPU_REGS_RSP]), ctxt->ss_base,
&dst.val, dst.bytes, ctxt->vcpu)) != 0) c->regs[VCPU_REGS_RSP]),
&c->dst.val,
c->dst.bytes,
ctxt->vcpu)) != 0)
goto done; goto done;
register_address_increment(_regs[VCPU_REGS_RSP], dst.bytes); register_address_increment(c->regs[VCPU_REGS_RSP],
c->dst.bytes);
break; break;
case 0xa0 ... 0xa1: /* mov */ case 0xa0 ... 0xa1: /* mov */
dst.ptr = (unsigned long *)&_regs[VCPU_REGS_RAX]; c->dst.ptr = (unsigned long *)&c->regs[VCPU_REGS_RAX];
dst.val = src.val; c->dst.val = c->src.val;
_eip += ad_bytes; /* skip src displacement */ /* skip src displacement */
c->eip += c->ad_bytes;
break; break;
case 0xa2 ... 0xa3: /* mov */ case 0xa2 ... 0xa3: /* mov */
dst.val = (unsigned long)_regs[VCPU_REGS_RAX]; c->dst.val = (unsigned long)c->regs[VCPU_REGS_RAX];
_eip += ad_bytes; /* skip dst displacement */ /* skip c->dst displacement */
c->eip += c->ad_bytes;
break; break;
case 0xc0 ... 0xc1: case 0xc0 ... 0xc1:
grp2: /* Grp2 */ grp2: /* Grp2 */
switch (modrm_reg) { switch (c->modrm_reg) {
case 0: /* rol */ case 0: /* rol */
emulate_2op_SrcB("rol", src, dst, _eflags); emulate_2op_SrcB("rol", c->src, c->dst, _eflags);
break; break;
case 1: /* ror */ case 1: /* ror */
emulate_2op_SrcB("ror", src, dst, _eflags); emulate_2op_SrcB("ror", c->src, c->dst, _eflags);
break; break;
case 2: /* rcl */ case 2: /* rcl */
emulate_2op_SrcB("rcl", src, dst, _eflags); emulate_2op_SrcB("rcl", c->src, c->dst, _eflags);
break; break;
case 3: /* rcr */ case 3: /* rcr */
emulate_2op_SrcB("rcr", src, dst, _eflags); emulate_2op_SrcB("rcr", c->src, c->dst, _eflags);
break; break;
case 4: /* sal/shl */ case 4: /* sal/shl */
case 6: /* sal/shl */ case 6: /* sal/shl */
emulate_2op_SrcB("sal", src, dst, _eflags); emulate_2op_SrcB("sal", c->src, c->dst, _eflags);
break; break;
case 5: /* shr */ case 5: /* shr */
emulate_2op_SrcB("shr", src, dst, _eflags); emulate_2op_SrcB("shr", c->src, c->dst, _eflags);
break; break;
case 7: /* sar */ case 7: /* sar */
emulate_2op_SrcB("sar", src, dst, _eflags); emulate_2op_SrcB("sar", c->src, c->dst, _eflags);
break; break;
} }
break; break;
case 0xc6 ... 0xc7: /* mov (sole member of Grp11) */ case 0xc6 ... 0xc7: /* mov (sole member of Grp11) */
mov: mov:
dst.val = src.val; c->dst.val = c->src.val;
break; break;
case 0xd0 ... 0xd1: /* Grp2 */ case 0xd0 ... 0xd1: /* Grp2 */
src.val = 1; c->src.val = 1;
goto grp2; goto grp2;
case 0xd2 ... 0xd3: /* Grp2 */ case 0xd2 ... 0xd3: /* Grp2 */
src.val = _regs[VCPU_REGS_RCX]; c->src.val = c->regs[VCPU_REGS_RCX];
goto grp2; goto grp2;
case 0xf6 ... 0xf7: /* Grp3 */ case 0xf6 ... 0xf7: /* Grp3 */
switch (modrm_reg) { switch (c->modrm_reg) {
case 0 ... 1: /* test */ case 0 ... 1: /* test */
/* /*
* Special case in Grp3: test has an immediate * Special case in Grp3: test has an immediate
* source operand. * source operand.
*/ */
src.type = OP_IMM; c->src.type = OP_IMM;
src.ptr = (unsigned long *)_eip; c->src.ptr = (unsigned long *)c->eip;
src.bytes = (d & ByteOp) ? 1 : op_bytes; c->src.bytes = (c->d & ByteOp) ? 1 :
if (src.bytes == 8) c->op_bytes;
src.bytes = 4; if (c->src.bytes == 8)
switch (src.bytes) { c->src.bytes = 4;
switch (c->src.bytes) {
case 1: case 1:
src.val = insn_fetch(s8, 1, _eip); c->src.val = insn_fetch(s8, 1, c->eip);
break; break;
case 2: case 2:
src.val = insn_fetch(s16, 2, _eip); c->src.val = insn_fetch(s16, 2, c->eip);
break; break;
case 4: case 4:
src.val = insn_fetch(s32, 4, _eip); c->src.val = insn_fetch(s32, 4, c->eip);
break; break;
} }
goto test; goto test;
case 2: /* not */ case 2: /* not */
dst.val = ~dst.val; c->dst.val = ~c->dst.val;
break; break;
case 3: /* neg */ case 3: /* neg */
emulate_1op("neg", dst, _eflags); emulate_1op("neg", c->dst, _eflags);
break; break;
default: default:
goto cannot_emulate; goto cannot_emulate;
} }
break; break;
case 0xfe ... 0xff: /* Grp4/Grp5 */ case 0xfe ... 0xff: /* Grp4/Grp5 */
switch (modrm_reg) { switch (c->modrm_reg) {
case 0: /* inc */ case 0: /* inc */
emulate_1op("inc", dst, _eflags); emulate_1op("inc", c->dst, _eflags);
break; break;
case 1: /* dec */ case 1: /* dec */
emulate_1op("dec", dst, _eflags); emulate_1op("dec", c->dst, _eflags);
break; break;
case 4: /* jmp abs */ case 4: /* jmp abs */
if (b == 0xff) if (c->b == 0xff)
_eip = dst.val; c->eip = c->dst.val;
else else
goto cannot_emulate; goto cannot_emulate;
break; break;
case 6: /* push */ case 6: /* push */
/* 64-bit mode: PUSH always pushes a 64-bit operand. */ /* 64-bit mode: PUSH always pushes a 64-bit operand. */
if (mode == X86EMUL_MODE_PROT64) { if (mode == X86EMUL_MODE_PROT64) {
dst.bytes = 8; c->dst.bytes = 8;
if ((rc = ops->read_std((unsigned long)dst.ptr, if ((rc = ops->read_std(
&dst.val, 8, (unsigned long)c->dst.ptr,
&c->dst.val, 8,
ctxt->vcpu)) != 0) ctxt->vcpu)) != 0)
goto done; goto done;
} }
register_address_increment(_regs[VCPU_REGS_RSP], register_address_increment(c->regs[VCPU_REGS_RSP],
-dst.bytes); -c->dst.bytes);
if ((rc = ops->write_emulated( if ((rc = ops->write_emulated(
register_address(ctxt->ss_base, register_address(ctxt->ss_base,
_regs[VCPU_REGS_RSP]), c->regs[VCPU_REGS_RSP]),
&dst.val, dst.bytes, ctxt->vcpu)) != 0) &c->dst.val,
c->dst.bytes, ctxt->vcpu)) != 0)
goto done; goto done;
no_wb = 1; no_wb = 1;
break; break;
...@@ -1161,33 +1178,39 @@ done_prefixes: ...@@ -1161,33 +1178,39 @@ done_prefixes:
writeback: writeback:
if (!no_wb) { if (!no_wb) {
switch (dst.type) { switch (c->dst.type) {
case OP_REG: case OP_REG:
/* The 4-byte case *is* correct: in 64-bit mode we zero-extend. */ /* The 4-byte case *is* correct:
switch (dst.bytes) { * in 64-bit mode we zero-extend.
*/
switch (c->dst.bytes) {
case 1: case 1:
*(u8 *)dst.ptr = (u8)dst.val; *(u8 *)c->dst.ptr = (u8)c->dst.val;
break; break;
case 2: case 2:
*(u16 *)dst.ptr = (u16)dst.val; *(u16 *)c->dst.ptr = (u16)c->dst.val;
break; break;
case 4: case 4:
*dst.ptr = (u32)dst.val; *c->dst.ptr = (u32)c->dst.val;
break; /* 64b: zero-ext */ break; /* 64b: zero-ext */
case 8: case 8:
*dst.ptr = dst.val; *c->dst.ptr = c->dst.val;
break; break;
} }
break; break;
case OP_MEM: case OP_MEM:
if (lock_prefix) if (c->lock_prefix)
rc = ops->cmpxchg_emulated((unsigned long)dst. rc = ops->cmpxchg_emulated(
ptr, &dst.orig_val, (unsigned long)c->dst.ptr,
&dst.val, dst.bytes, &c->dst.orig_val,
&c->dst.val,
c->dst.bytes,
ctxt->vcpu); ctxt->vcpu);
else else
rc = ops->write_emulated((unsigned long)dst.ptr, rc = ops->write_emulated(
&dst.val, dst.bytes, (unsigned long)c->dst.ptr,
&c->dst.val,
c->dst.bytes,
ctxt->vcpu); ctxt->vcpu);
if (rc != 0) if (rc != 0)
goto done; goto done;
...@@ -1197,173 +1220,185 @@ writeback: ...@@ -1197,173 +1220,185 @@ writeback:
} }
/* Commit shadow register state. */ /* Commit shadow register state. */
memcpy(ctxt->vcpu->regs, _regs, sizeof _regs); memcpy(ctxt->vcpu->regs, c->regs, sizeof c->regs);
ctxt->eflags = _eflags; ctxt->eflags = _eflags;
ctxt->vcpu->rip = _eip; ctxt->vcpu->rip = c->eip;
done: done:
return (rc == X86EMUL_UNHANDLEABLE) ? -1 : 0; return (rc == X86EMUL_UNHANDLEABLE) ? -1 : 0;
special_insn: special_insn:
if (twobyte) if (c->twobyte)
goto twobyte_special_insn; goto twobyte_special_insn;
switch(b) { switch (c->b) {
case 0x50 ... 0x57: /* push reg */ case 0x50 ... 0x57: /* push reg */
if (op_bytes == 2) if (c->op_bytes == 2)
src.val = (u16) _regs[b & 0x7]; c->src.val = (u16) c->regs[c->b & 0x7];
else else
src.val = (u32) _regs[b & 0x7]; c->src.val = (u32) c->regs[c->b & 0x7];
dst.type = OP_MEM; c->dst.type = OP_MEM;
dst.bytes = op_bytes; c->dst.bytes = c->op_bytes;
dst.val = src.val; c->dst.val = c->src.val;
register_address_increment(_regs[VCPU_REGS_RSP], -op_bytes); register_address_increment(c->regs[VCPU_REGS_RSP],
dst.ptr = (void *) register_address( -c->op_bytes);
ctxt->ss_base, _regs[VCPU_REGS_RSP]); c->dst.ptr = (void *) register_address(
ctxt->ss_base, c->regs[VCPU_REGS_RSP]);
break; break;
case 0x58 ... 0x5f: /* pop reg */ case 0x58 ... 0x5f: /* pop reg */
dst.ptr = (unsigned long *)&_regs[b & 0x7]; c->dst.ptr =
(unsigned long *)&c->regs[c->b & 0x7];
pop_instruction: pop_instruction:
if ((rc = ops->read_std(register_address(ctxt->ss_base, if ((rc = ops->read_std(register_address(ctxt->ss_base,
_regs[VCPU_REGS_RSP]), dst.ptr, op_bytes, ctxt->vcpu)) c->regs[VCPU_REGS_RSP]), c->dst.ptr,
!= 0) c->op_bytes, ctxt->vcpu)) != 0)
goto done; goto done;
register_address_increment(_regs[VCPU_REGS_RSP], op_bytes); register_address_increment(c->regs[VCPU_REGS_RSP],
c->op_bytes);
no_wb = 1; /* Disable writeback. */ no_wb = 1; /* Disable writeback. */
break; break;
case 0x6a: /* push imm8 */ case 0x6a: /* push imm8 */
src.val = 0L; c->src.val = 0L;
src.val = insn_fetch(s8, 1, _eip); c->src.val = insn_fetch(s8, 1, c->eip);
push: push:
dst.type = OP_MEM; c->dst.type = OP_MEM;
dst.bytes = op_bytes; c->dst.bytes = c->op_bytes;
dst.val = src.val; c->dst.val = c->src.val;
register_address_increment(_regs[VCPU_REGS_RSP], -op_bytes); register_address_increment(c->regs[VCPU_REGS_RSP],
dst.ptr = (void *) register_address(ctxt->ss_base, -c->op_bytes);
_regs[VCPU_REGS_RSP]); c->dst.ptr = (void *) register_address(ctxt->ss_base,
c->regs[VCPU_REGS_RSP]);
break; break;
case 0x6c: /* insb */ case 0x6c: /* insb */
case 0x6d: /* insw/insd */ case 0x6d: /* insw/insd */
if (kvm_emulate_pio_string(ctxt->vcpu, NULL, if (kvm_emulate_pio_string(ctxt->vcpu, NULL,
1, /* in */ 1,
(d & ByteOp) ? 1 : op_bytes, /* size */ (c->d & ByteOp) ? 1 : c->op_bytes,
rep_prefix ? c->rep_prefix ?
address_mask(_regs[VCPU_REGS_RCX]) : 1, /* count */ address_mask(c->regs[VCPU_REGS_RCX]) : 1,
(_eflags & EFLG_DF), /* down */ (_eflags & EFLG_DF),
register_address(ctxt->es_base, register_address(ctxt->es_base,
_regs[VCPU_REGS_RDI]), /* address */ c->regs[VCPU_REGS_RDI]),
rep_prefix, c->rep_prefix,
_regs[VCPU_REGS_RDX] /* port */ c->regs[VCPU_REGS_RDX]) == 0)
) == 0)
return -1; return -1;
return 0; return 0;
case 0x6e: /* outsb */ case 0x6e: /* outsb */
case 0x6f: /* outsw/outsd */ case 0x6f: /* outsw/outsd */
if (kvm_emulate_pio_string(ctxt->vcpu, NULL, if (kvm_emulate_pio_string(ctxt->vcpu, NULL,
0, /* in */ 0,
(d & ByteOp) ? 1 : op_bytes, /* size */ (c->d & ByteOp) ? 1 : c->op_bytes,
rep_prefix ? c->rep_prefix ?
address_mask(_regs[VCPU_REGS_RCX]) : 1, /* count */ address_mask(c->regs[VCPU_REGS_RCX]) : 1,
(_eflags & EFLG_DF), /* down */ (_eflags & EFLG_DF),
register_address(override_base ? register_address(c->override_base ?
*override_base : ctxt->ds_base, *c->override_base :
_regs[VCPU_REGS_RSI]), /* address */ ctxt->ds_base,
rep_prefix, c->regs[VCPU_REGS_RSI]),
_regs[VCPU_REGS_RDX] /* port */ c->rep_prefix,
) == 0) c->regs[VCPU_REGS_RDX]) == 0)
return -1; return -1;
return 0; return 0;
case 0x70 ... 0x7f: /* jcc (short) */ { case 0x70 ... 0x7f: /* jcc (short) */ {
int rel = insn_fetch(s8, 1, _eip); int rel = insn_fetch(s8, 1, c->eip);
if (test_cc(b, _eflags)) if (test_cc(c->b, _eflags))
JMP_REL(rel); JMP_REL(rel);
break; break;
} }
case 0x9c: /* pushf */ case 0x9c: /* pushf */
src.val = (unsigned long) _eflags; c->src.val = (unsigned long) _eflags;
goto push; goto push;
case 0x9d: /* popf */ case 0x9d: /* popf */
dst.ptr = (unsigned long *) &_eflags; c->dst.ptr = (unsigned long *) &_eflags;
goto pop_instruction; goto pop_instruction;
case 0xc3: /* ret */ case 0xc3: /* ret */
dst.ptr = &_eip; c->dst.ptr = &c->eip;
goto pop_instruction; goto pop_instruction;
case 0xf4: /* hlt */ case 0xf4: /* hlt */
ctxt->vcpu->halt_request = 1; ctxt->vcpu->halt_request = 1;
goto done; goto done;
} }
if (rep_prefix) { if (c->rep_prefix) {
if (_regs[VCPU_REGS_RCX] == 0) { if (c->regs[VCPU_REGS_RCX] == 0) {
ctxt->vcpu->rip = _eip; ctxt->vcpu->rip = c->eip;
goto done; goto done;
} }
_regs[VCPU_REGS_RCX]--; c->regs[VCPU_REGS_RCX]--;
_eip = ctxt->vcpu->rip; c->eip = ctxt->vcpu->rip;
} }
switch (b) { switch (c->b) {
case 0xa4 ... 0xa5: /* movs */ case 0xa4 ... 0xa5: /* movs */
dst.type = OP_MEM; c->dst.type = OP_MEM;
dst.bytes = (d & ByteOp) ? 1 : op_bytes; c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
dst.ptr = (unsigned long *)register_address(ctxt->es_base, c->dst.ptr = (unsigned long *)register_address(
_regs[VCPU_REGS_RDI]); ctxt->es_base,
c->regs[VCPU_REGS_RDI]);
if ((rc = ops->read_emulated(register_address( if ((rc = ops->read_emulated(register_address(
override_base ? *override_base : ctxt->ds_base, c->override_base ? *c->override_base :
_regs[VCPU_REGS_RSI]), &dst.val, dst.bytes, ctxt->vcpu)) != 0) ctxt->ds_base,
c->regs[VCPU_REGS_RSI]),
&c->dst.val,
c->dst.bytes, ctxt->vcpu)) != 0)
goto done; goto done;
register_address_increment(_regs[VCPU_REGS_RSI], register_address_increment(c->regs[VCPU_REGS_RSI],
(_eflags & EFLG_DF) ? -dst.bytes : dst.bytes); (_eflags & EFLG_DF) ? -c->dst.bytes
register_address_increment(_regs[VCPU_REGS_RDI], : c->dst.bytes);
(_eflags & EFLG_DF) ? -dst.bytes : dst.bytes); register_address_increment(c->regs[VCPU_REGS_RDI],
(_eflags & EFLG_DF) ? -c->dst.bytes
: c->dst.bytes);
break; break;
case 0xa6 ... 0xa7: /* cmps */ case 0xa6 ... 0xa7: /* cmps */
DPRINTF("Urk! I don't handle CMPS.\n"); DPRINTF("Urk! I don't handle CMPS.\n");
goto cannot_emulate; goto cannot_emulate;
case 0xaa ... 0xab: /* stos */ case 0xaa ... 0xab: /* stos */
dst.type = OP_MEM; c->dst.type = OP_MEM;
dst.bytes = (d & ByteOp) ? 1 : op_bytes; c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
dst.ptr = (unsigned long *)cr2; c->dst.ptr = (unsigned long *)cr2;
dst.val = _regs[VCPU_REGS_RAX]; c->dst.val = c->regs[VCPU_REGS_RAX];
register_address_increment(_regs[VCPU_REGS_RDI], register_address_increment(c->regs[VCPU_REGS_RDI],
(_eflags & EFLG_DF) ? -dst.bytes : dst.bytes); (_eflags & EFLG_DF) ? -c->dst.bytes
: c->dst.bytes);
break; break;
case 0xac ... 0xad: /* lods */ case 0xac ... 0xad: /* lods */
dst.type = OP_REG; c->dst.type = OP_REG;
dst.bytes = (d & ByteOp) ? 1 : op_bytes; c->dst.bytes = (c->d & ByteOp) ? 1 : c->op_bytes;
dst.ptr = (unsigned long *)&_regs[VCPU_REGS_RAX]; c->dst.ptr = (unsigned long *)&c->regs[VCPU_REGS_RAX];
if ((rc = ops->read_emulated(cr2, &dst.val, dst.bytes, if ((rc = ops->read_emulated(cr2, &c->dst.val,
c->dst.bytes,
ctxt->vcpu)) != 0) ctxt->vcpu)) != 0)
goto done; goto done;
register_address_increment(_regs[VCPU_REGS_RSI], register_address_increment(c->regs[VCPU_REGS_RSI],
(_eflags & EFLG_DF) ? -dst.bytes : dst.bytes); (_eflags & EFLG_DF) ? -c->dst.bytes
: c->dst.bytes);
break; break;
case 0xae ... 0xaf: /* scas */ case 0xae ... 0xaf: /* scas */
DPRINTF("Urk! I don't handle SCAS.\n"); DPRINTF("Urk! I don't handle SCAS.\n");
goto cannot_emulate; goto cannot_emulate;
case 0xe8: /* call (near) */ { case 0xe8: /* call (near) */ {
long int rel; long int rel;
switch (op_bytes) { switch (c->op_bytes) {
case 2: case 2:
rel = insn_fetch(s16, 2, _eip); rel = insn_fetch(s16, 2, c->eip);
break; break;
case 4: case 4:
rel = insn_fetch(s32, 4, _eip); rel = insn_fetch(s32, 4, c->eip);
break; break;
case 8: case 8:
rel = insn_fetch(s64, 8, _eip); rel = insn_fetch(s64, 8, c->eip);
break; break;
default: default:
DPRINTF("Call: Invalid op_bytes\n"); DPRINTF("Call: Invalid op_bytes\n");
goto cannot_emulate; goto cannot_emulate;
} }
src.val = (unsigned long) _eip; c->src.val = (unsigned long) c->eip;
JMP_REL(rel); JMP_REL(rel);
op_bytes = ad_bytes; c->op_bytes = c->ad_bytes;
goto push; goto push;
} }
case 0xe9: /* jmp rel */ case 0xe9: /* jmp rel */
case 0xeb: /* jmp rel short */ case 0xeb: /* jmp rel short */
JMP_REL(src.val); JMP_REL(c->src.val);
no_wb = 1; /* Disable writeback. */ no_wb = 1; /* Disable writeback. */
break; break;
...@@ -1372,16 +1407,16 @@ special_insn: ...@@ -1372,16 +1407,16 @@ special_insn:
goto writeback; goto writeback;
twobyte_insn: twobyte_insn:
switch (b) { switch (c->b) {
case 0x01: /* lgdt, lidt, lmsw */ case 0x01: /* lgdt, lidt, lmsw */
/* Disable writeback. */ /* Disable writeback. */
no_wb = 1; no_wb = 1;
switch (modrm_reg) { switch (c->modrm_reg) {
u16 size; u16 size;
unsigned long address; unsigned long address;
case 0: /* vmcall */ case 0: /* vmcall */
if (modrm_mod != 3 || modrm_rm != 1) if (c->modrm_mod != 3 || c->modrm_rm != 1)
goto cannot_emulate; goto cannot_emulate;
rc = kvm_fix_hypercall(ctxt->vcpu); rc = kvm_fix_hypercall(ctxt->vcpu);
...@@ -1391,37 +1426,37 @@ twobyte_insn: ...@@ -1391,37 +1426,37 @@ twobyte_insn:
kvm_emulate_hypercall(ctxt->vcpu); kvm_emulate_hypercall(ctxt->vcpu);
break; break;
case 2: /* lgdt */ case 2: /* lgdt */
rc = read_descriptor(ctxt, ops, src.ptr, rc = read_descriptor(ctxt, ops, c->src.ptr,
&size, &address, op_bytes); &size, &address, c->op_bytes);
if (rc) if (rc)
goto done; goto done;
realmode_lgdt(ctxt->vcpu, size, address); realmode_lgdt(ctxt->vcpu, size, address);
break; break;
case 3: /* lidt/vmmcall */ case 3: /* lidt/vmmcall */
if (modrm_mod == 3 && modrm_rm == 1) { if (c->modrm_mod == 3 && c->modrm_rm == 1) {
rc = kvm_fix_hypercall(ctxt->vcpu); rc = kvm_fix_hypercall(ctxt->vcpu);
if (rc) if (rc)
goto done; goto done;
kvm_emulate_hypercall(ctxt->vcpu); kvm_emulate_hypercall(ctxt->vcpu);
} else { } else {
rc = read_descriptor(ctxt, ops, src.ptr, rc = read_descriptor(ctxt, ops, c->src.ptr,
&size, &address, &size, &address,
op_bytes); c->op_bytes);
if (rc) if (rc)
goto done; goto done;
realmode_lidt(ctxt->vcpu, size, address); realmode_lidt(ctxt->vcpu, size, address);
} }
break; break;
case 4: /* smsw */ case 4: /* smsw */
if (modrm_mod != 3) if (c->modrm_mod != 3)
goto cannot_emulate; goto cannot_emulate;
*(u16 *)&_regs[modrm_rm] *(u16 *)&c->regs[c->modrm_rm]
= realmode_get_cr(ctxt->vcpu, 0); = realmode_get_cr(ctxt->vcpu, 0);
break; break;
case 6: /* lmsw */ case 6: /* lmsw */
if (modrm_mod != 3) if (c->modrm_mod != 3)
goto cannot_emulate; goto cannot_emulate;
realmode_lmsw(ctxt->vcpu, (u16)modrm_val, &_eflags); realmode_lmsw(ctxt->vcpu, (u16)c->modrm_val, &_eflags);
break; break;
case 7: /* invlpg*/ case 7: /* invlpg*/
emulate_invlpg(ctxt->vcpu, cr2); emulate_invlpg(ctxt->vcpu, cr2);
...@@ -1432,24 +1467,26 @@ twobyte_insn: ...@@ -1432,24 +1467,26 @@ twobyte_insn:
break; break;
case 0x21: /* mov from dr to reg */ case 0x21: /* mov from dr to reg */
no_wb = 1; no_wb = 1;
if (modrm_mod != 3) if (c->modrm_mod != 3)
goto cannot_emulate; goto cannot_emulate;
rc = emulator_get_dr(ctxt, modrm_reg, &_regs[modrm_rm]); rc = emulator_get_dr(ctxt, c->modrm_reg,
&c->regs[c->modrm_rm]);
break; break;
case 0x23: /* mov from reg to dr */ case 0x23: /* mov from reg to dr */
no_wb = 1; no_wb = 1;
if (modrm_mod != 3) if (c->modrm_mod != 3)
goto cannot_emulate; goto cannot_emulate;
rc = emulator_set_dr(ctxt, modrm_reg, _regs[modrm_rm]); rc = emulator_set_dr(ctxt, c->modrm_reg,
c->regs[c->modrm_rm]);
break; break;
case 0x40 ... 0x4f: /* cmov */ case 0x40 ... 0x4f: /* cmov */
dst.val = dst.orig_val = src.val; c->dst.val = c->dst.orig_val = c->src.val;
no_wb = 1; no_wb = 1;
/* /*
* First, assume we're decoding an even cmov opcode * First, assume we're decoding an even cmov opcode
* (lsb == 0). * (lsb == 0).
*/ */
switch ((b & 15) >> 1) { switch ((c->b & 15) >> 1) {
case 0: /* cmovo */ case 0: /* cmovo */
no_wb = (_eflags & EFLG_OF) ? 0 : 1; no_wb = (_eflags & EFLG_OF) ? 0 : 1;
break; break;
...@@ -1477,46 +1514,50 @@ twobyte_insn: ...@@ -1477,46 +1514,50 @@ twobyte_insn:
break; break;
} }
/* Odd cmov opcodes (lsb == 1) have inverted sense. */ /* Odd cmov opcodes (lsb == 1) have inverted sense. */
no_wb ^= b & 1; no_wb ^= c->b & 1;
break; break;
case 0xa3: case 0xa3:
bt: /* bt */ bt: /* bt */
src.val &= (dst.bytes << 3) - 1; /* only subword offset */ /* only subword offset */
emulate_2op_SrcV_nobyte("bt", src, dst, _eflags); c->src.val &= (c->dst.bytes << 3) - 1;
emulate_2op_SrcV_nobyte("bt", c->src, c->dst, _eflags);
break; break;
case 0xab: case 0xab:
bts: /* bts */ bts: /* bts */
src.val &= (dst.bytes << 3) - 1; /* only subword offset */ /* only subword offset */
emulate_2op_SrcV_nobyte("bts", src, dst, _eflags); c->src.val &= (c->dst.bytes << 3) - 1;
emulate_2op_SrcV_nobyte("bts", c->src, c->dst, _eflags);
break; break;
case 0xb0 ... 0xb1: /* cmpxchg */ case 0xb0 ... 0xb1: /* cmpxchg */
/* /*
* Save real source value, then compare EAX against * Save real source value, then compare EAX against
* destination. * destination.
*/ */
src.orig_val = src.val; c->src.orig_val = c->src.val;
src.val = _regs[VCPU_REGS_RAX]; c->src.val = c->regs[VCPU_REGS_RAX];
emulate_2op_SrcV("cmp", src, dst, _eflags); emulate_2op_SrcV("cmp", c->src, c->dst, _eflags);
if (_eflags & EFLG_ZF) { if (_eflags & EFLG_ZF) {
/* Success: write back to memory. */ /* Success: write back to memory. */
dst.val = src.orig_val; c->dst.val = c->src.orig_val;
} else { } else {
/* Failure: write the value we saw to EAX. */ /* Failure: write the value we saw to EAX. */
dst.type = OP_REG; c->dst.type = OP_REG;
dst.ptr = (unsigned long *)&_regs[VCPU_REGS_RAX]; c->dst.ptr = (unsigned long *)&c->regs[VCPU_REGS_RAX];
} }
break; break;
case 0xb3: case 0xb3:
btr: /* btr */ btr: /* btr */
src.val &= (dst.bytes << 3) - 1; /* only subword offset */ /* only subword offset */
emulate_2op_SrcV_nobyte("btr", src, dst, _eflags); c->src.val &= (c->dst.bytes << 3) - 1;
emulate_2op_SrcV_nobyte("btr", c->src, c->dst, _eflags);
break; break;
case 0xb6 ... 0xb7: /* movzx */ case 0xb6 ... 0xb7: /* movzx */
dst.bytes = op_bytes; c->dst.bytes = c->op_bytes;
dst.val = (d & ByteOp) ? (u8) src.val : (u16) src.val; c->dst.val = (c->d & ByteOp) ? (u8) c->src.val
: (u16) c->src.val;
break; break;
case 0xba: /* Grp8 */ case 0xba: /* Grp8 */
switch (modrm_reg & 3) { switch (c->modrm_reg & 3) {
case 0: case 0:
goto bt; goto bt;
case 1: case 1:
...@@ -1529,16 +1570,19 @@ twobyte_insn: ...@@ -1529,16 +1570,19 @@ twobyte_insn:
break; break;
case 0xbb: case 0xbb:
btc: /* btc */ btc: /* btc */
src.val &= (dst.bytes << 3) - 1; /* only subword offset */ /* only subword offset */
emulate_2op_SrcV_nobyte("btc", src, dst, _eflags); c->src.val &= (c->dst.bytes << 3) - 1;
emulate_2op_SrcV_nobyte("btc", c->src, c->dst, _eflags);
break; break;
case 0xbe ... 0xbf: /* movsx */ case 0xbe ... 0xbf: /* movsx */
dst.bytes = op_bytes; c->dst.bytes = c->op_bytes;
dst.val = (d & ByteOp) ? (s8) src.val : (s16) src.val; c->dst.val = (c->d & ByteOp) ? (s8) c->src.val :
(s16) c->src.val;
break; break;
case 0xc3: /* movnti */ case 0xc3: /* movnti */
dst.bytes = op_bytes; c->dst.bytes = c->op_bytes;
dst.val = (op_bytes == 4) ? (u32) src.val : (u64) src.val; c->dst.val = (c->op_bytes == 4) ? (u32) c->src.val :
(u64) c->src.val;
break; break;
} }
goto writeback; goto writeback;
...@@ -1546,7 +1590,7 @@ twobyte_insn: ...@@ -1546,7 +1590,7 @@ twobyte_insn:
twobyte_special_insn: twobyte_special_insn:
/* Disable writeback. */ /* Disable writeback. */
no_wb = 1; no_wb = 1;
switch (b) { switch (c->b) {
case 0x06: case 0x06:
emulate_clts(ctxt->vcpu); emulate_clts(ctxt->vcpu);
break; break;
...@@ -1558,56 +1602,59 @@ twobyte_special_insn: ...@@ -1558,56 +1602,59 @@ twobyte_special_insn:
case 0x18: /* Grp16 (prefetch/nop) */ case 0x18: /* Grp16 (prefetch/nop) */
break; break;
case 0x20: /* mov cr, reg */ case 0x20: /* mov cr, reg */
if (modrm_mod != 3) if (c->modrm_mod != 3)
goto cannot_emulate; goto cannot_emulate;
_regs[modrm_rm] = realmode_get_cr(ctxt->vcpu, modrm_reg); c->regs[c->modrm_rm] =
realmode_get_cr(ctxt->vcpu, c->modrm_reg);
break; break;
case 0x22: /* mov reg, cr */ case 0x22: /* mov reg, cr */
if (modrm_mod != 3) if (c->modrm_mod != 3)
goto cannot_emulate; goto cannot_emulate;
realmode_set_cr(ctxt->vcpu, modrm_reg, modrm_val, &_eflags); realmode_set_cr(ctxt->vcpu,
c->modrm_reg, c->modrm_val, &_eflags);
break; break;
case 0x30: case 0x30:
/* wrmsr */ /* wrmsr */
msr_data = (u32)_regs[VCPU_REGS_RAX] msr_data = (u32)c->regs[VCPU_REGS_RAX]
| ((u64)_regs[VCPU_REGS_RDX] << 32); | ((u64)c->regs[VCPU_REGS_RDX] << 32);
rc = kvm_set_msr(ctxt->vcpu, _regs[VCPU_REGS_RCX], msr_data); rc = kvm_set_msr(ctxt->vcpu, c->regs[VCPU_REGS_RCX], msr_data);
if (rc) { if (rc) {
kvm_x86_ops->inject_gp(ctxt->vcpu, 0); kvm_x86_ops->inject_gp(ctxt->vcpu, 0);
_eip = ctxt->vcpu->rip; c->eip = ctxt->vcpu->rip;
} }
rc = X86EMUL_CONTINUE; rc = X86EMUL_CONTINUE;
break; break;
case 0x32: case 0x32:
/* rdmsr */ /* rdmsr */
rc = kvm_get_msr(ctxt->vcpu, _regs[VCPU_REGS_RCX], &msr_data); rc = kvm_get_msr(ctxt->vcpu,
c->regs[VCPU_REGS_RCX], &msr_data);
if (rc) { if (rc) {
kvm_x86_ops->inject_gp(ctxt->vcpu, 0); kvm_x86_ops->inject_gp(ctxt->vcpu, 0);
_eip = ctxt->vcpu->rip; c->eip = ctxt->vcpu->rip;
} else { } else {
_regs[VCPU_REGS_RAX] = (u32)msr_data; c->regs[VCPU_REGS_RAX] = (u32)msr_data;
_regs[VCPU_REGS_RDX] = msr_data >> 32; c->regs[VCPU_REGS_RDX] = msr_data >> 32;
} }
rc = X86EMUL_CONTINUE; rc = X86EMUL_CONTINUE;
break; break;
case 0x80 ... 0x8f: /* jnz rel, etc*/ { case 0x80 ... 0x8f: /* jnz rel, etc*/ {
long int rel; long int rel;
switch (op_bytes) { switch (c->op_bytes) {
case 2: case 2:
rel = insn_fetch(s16, 2, _eip); rel = insn_fetch(s16, 2, c->eip);
break; break;
case 4: case 4:
rel = insn_fetch(s32, 4, _eip); rel = insn_fetch(s32, 4, c->eip);
break; break;
case 8: case 8:
rel = insn_fetch(s64, 8, _eip); rel = insn_fetch(s64, 8, c->eip);
break; break;
default: default:
DPRINTF("jnz: Invalid op_bytes\n"); DPRINTF("jnz: Invalid op_bytes\n");
goto cannot_emulate; goto cannot_emulate;
} }
if (test_cc(b, _eflags)) if (test_cc(c->b, _eflags))
JMP_REL(rel); JMP_REL(rel);
break; break;
} }
...@@ -1617,14 +1664,16 @@ twobyte_special_insn: ...@@ -1617,14 +1664,16 @@ twobyte_special_insn:
if ((rc = ops->read_emulated(cr2, &old, 8, ctxt->vcpu)) if ((rc = ops->read_emulated(cr2, &old, 8, ctxt->vcpu))
!= 0) != 0)
goto done; goto done;
if (((u32) (old >> 0) != (u32) _regs[VCPU_REGS_RAX]) || if (((u32) (old >> 0) !=
((u32) (old >> 32) != (u32) _regs[VCPU_REGS_RDX])) { (u32) c->regs[VCPU_REGS_RAX]) ||
_regs[VCPU_REGS_RAX] = (u32) (old >> 0); ((u32) (old >> 32) !=
_regs[VCPU_REGS_RDX] = (u32) (old >> 32); (u32) c->regs[VCPU_REGS_RDX])) {
c->regs[VCPU_REGS_RAX] = (u32) (old >> 0);
c->regs[VCPU_REGS_RDX] = (u32) (old >> 32);
_eflags &= ~EFLG_ZF; _eflags &= ~EFLG_ZF;
} else { } else {
new = ((u64)_regs[VCPU_REGS_RCX] << 32) new = ((u64)c->regs[VCPU_REGS_RCX] << 32)
| (u32) _regs[VCPU_REGS_RBX]; | (u32) c->regs[VCPU_REGS_RBX];
if ((rc = ops->cmpxchg_emulated(cr2, &old, if ((rc = ops->cmpxchg_emulated(cr2, &old,
&new, 8, ctxt->vcpu)) != 0) &new, 8, ctxt->vcpu)) != 0)
goto done; goto done;
...@@ -1636,6 +1685,6 @@ twobyte_special_insn: ...@@ -1636,6 +1685,6 @@ twobyte_special_insn:
goto writeback; goto writeback;
cannot_emulate: cannot_emulate:
DPRINTF("Cannot emulate %02x\n", b); DPRINTF("Cannot emulate %02x\n", c->b);
return -1; return -1;
} }
...@@ -112,6 +112,36 @@ struct x86_emulate_ops { ...@@ -112,6 +112,36 @@ struct x86_emulate_ops {
}; };
/* Type, address-of, and value of an instruction's operand. */
struct operand {
enum { OP_REG, OP_MEM, OP_IMM } type;
unsigned int bytes;
unsigned long val, orig_val, *ptr;
};
struct decode_cache {
u8 twobyte;
u8 b;
u8 lock_prefix;
u8 rep_prefix;
u8 op_bytes;
u8 ad_bytes;
struct operand src;
struct operand dst;
unsigned long *override_base;
unsigned int d;
unsigned long regs[NR_VCPU_REGS];
unsigned long eip;
/* modrm */
u8 modrm;
u8 modrm_mod;
u8 modrm_reg;
u8 modrm_rm;
u8 use_modrm_ea;
unsigned long modrm_ea;
unsigned long modrm_val;
};
struct x86_emulate_ctxt { struct x86_emulate_ctxt {
/* Register state before/after emulation. */ /* Register state before/after emulation. */
struct kvm_vcpu *vcpu; struct kvm_vcpu *vcpu;
...@@ -129,6 +159,10 @@ struct x86_emulate_ctxt { ...@@ -129,6 +159,10 @@ struct x86_emulate_ctxt {
unsigned long ss_base; unsigned long ss_base;
unsigned long gs_base; unsigned long gs_base;
unsigned long fs_base; unsigned long fs_base;
/* decode cache */
struct decode_cache decode;
}; };
/* Execution mode, passed to the emulator. */ /* Execution mode, passed to the emulator. */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment