|
|
|
|
@@ -11,13 +11,10 @@
|
|
|
|
|
|
|
|
|
|
#include "xenia/base/assert.h"
|
|
|
|
|
#include "xenia/base/byte_order.h"
|
|
|
|
|
#include "xenia/base/logging.h"
|
|
|
|
|
#include "xenia/base/math.h"
|
|
|
|
|
#include "xenia/base/memory.h"
|
|
|
|
|
|
|
|
|
|
namespace BE {
|
|
|
|
|
#include <beaengine/BeaEngine.h>
|
|
|
|
|
} // namespace BE
|
|
|
|
|
|
|
|
|
|
namespace xe {
|
|
|
|
|
namespace cpu {
|
|
|
|
|
|
|
|
|
|
@@ -71,7 +68,7 @@ MMIORange* MMIOHandler::LookupRange(uint32_t virtual_address) {
|
|
|
|
|
return nullptr;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool MMIOHandler::CheckLoad(uint32_t virtual_address, uint64_t* out_value) {
|
|
|
|
|
bool MMIOHandler::CheckLoad(uint32_t virtual_address, uint32_t* out_value) {
|
|
|
|
|
for (const auto& range : mapped_ranges_) {
|
|
|
|
|
if ((virtual_address & range.mask) == range.address) {
|
|
|
|
|
*out_value = static_cast<uint32_t>(
|
|
|
|
|
@@ -82,7 +79,7 @@ bool MMIOHandler::CheckLoad(uint32_t virtual_address, uint64_t* out_value) {
|
|
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool MMIOHandler::CheckStore(uint32_t virtual_address, uint64_t value) {
|
|
|
|
|
bool MMIOHandler::CheckStore(uint32_t virtual_address, uint32_t value) {
|
|
|
|
|
for (const auto& range : mapped_ranges_) {
|
|
|
|
|
if ((virtual_address & range.mask) == range.address) {
|
|
|
|
|
range.write(nullptr, range.callback_context, virtual_address, value);
|
|
|
|
|
@@ -205,6 +202,167 @@ bool MMIOHandler::CheckWriteWatch(void* thread_state, uint64_t fault_address) {
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
struct DecodedMov {
|
|
|
|
|
size_t length;
|
|
|
|
|
// Inidicates this is a load (or conversely a store).
|
|
|
|
|
bool is_load;
|
|
|
|
|
// Indicates the memory must be swapped.
|
|
|
|
|
bool byte_swap;
|
|
|
|
|
// Source (for store) or target (for load) register.
|
|
|
|
|
// AX CX DX BX SP BP SI DI // REX.R=0
|
|
|
|
|
// R8 R9 R10 R11 R12 R13 R14 R15 // REX.R=1
|
|
|
|
|
uint32_t value_reg;
|
|
|
|
|
// [base + (index * scale) + displacement]
|
|
|
|
|
bool mem_has_base;
|
|
|
|
|
uint8_t mem_base_reg;
|
|
|
|
|
bool mem_has_index;
|
|
|
|
|
uint8_t mem_index_reg;
|
|
|
|
|
uint8_t mem_scale;
|
|
|
|
|
int32_t mem_displacement;
|
|
|
|
|
bool is_constant;
|
|
|
|
|
int32_t constant;
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
bool TryDecodeMov(const uint8_t* p, DecodedMov& mov) {
|
|
|
|
|
uint8_t i = 0; // Current byte decode index.
|
|
|
|
|
uint8_t rex = 0;
|
|
|
|
|
if ((p[i] & 0xF0) == 0x40) {
|
|
|
|
|
rex = p[0];
|
|
|
|
|
++i;
|
|
|
|
|
}
|
|
|
|
|
if (p[i] == 0x0F && p[i + 1] == 0x38 && p[i + 2] == 0xF1) {
|
|
|
|
|
// MOVBE m32, r32 (store)
|
|
|
|
|
// http://www.tptp.cc/mirrors/siyobik.info/instruction/MOVBE.html
|
|
|
|
|
// 44 0f 38 f1 a4 02 00 movbe DWORD PTR [rdx+rax*1+0x0],r12d
|
|
|
|
|
// 42 0f 38 f1 8c 22 00 movbe DWORD PTR [rdx+r12*1+0x0],ecx
|
|
|
|
|
// 0f 38 f1 8c 02 00 00 movbe DWORD PTR [rdx + rax * 1 + 0x0], ecx
|
|
|
|
|
mov.is_load = false;
|
|
|
|
|
mov.byte_swap = true;
|
|
|
|
|
i += 3;
|
|
|
|
|
} else if (p[i] == 0x0F && p[i + 1] == 0x38 && p[i + 2] == 0xF0) {
|
|
|
|
|
// MOVBE r32, m32 (load)
|
|
|
|
|
// http://www.tptp.cc/mirrors/siyobik.info/instruction/MOVBE.html
|
|
|
|
|
// 44 0f 38 f0 a4 02 00 movbe r12d,DWORD PTR [rdx+rax*1+0x0]
|
|
|
|
|
// 42 0f 38 f0 8c 22 00 movbe ecx,DWORD PTR [rdx+r12*1+0x0]
|
|
|
|
|
// 46 0f 38 f0 a4 22 00 movbe r12d,DWORD PTR [rdx+r12*1+0x0]
|
|
|
|
|
// 0f 38 f0 8c 02 00 00 movbe ecx,DWORD PTR [rdx+rax*1+0x0]
|
|
|
|
|
// 0F 38 F0 1C 02 movbe ebx,dword ptr [rdx+rax]
|
|
|
|
|
mov.is_load = true;
|
|
|
|
|
mov.byte_swap = true;
|
|
|
|
|
i += 3;
|
|
|
|
|
} else if (p[i] == 0x89) {
|
|
|
|
|
// MOV m32, r32 (store)
|
|
|
|
|
// http://www.tptp.cc/mirrors/siyobik.info/instruction/MOV.html
|
|
|
|
|
// 44 89 24 02 mov DWORD PTR[rdx + rax * 1], r12d
|
|
|
|
|
// 42 89 0c 22 mov DWORD PTR[rdx + r12 * 1], ecx
|
|
|
|
|
// 89 0c 02 mov DWORD PTR[rdx + rax * 1], ecx
|
|
|
|
|
mov.is_load = false;
|
|
|
|
|
mov.byte_swap = false;
|
|
|
|
|
++i;
|
|
|
|
|
} else if (p[i] == 0x8B) {
|
|
|
|
|
// MOV r32, m32 (load)
|
|
|
|
|
// http://www.tptp.cc/mirrors/siyobik.info/instruction/MOV.html
|
|
|
|
|
// 44 8b 24 02 mov r12d, DWORD PTR[rdx + rax * 1]
|
|
|
|
|
// 42 8b 0c 22 mov ecx, DWORD PTR[rdx + r12 * 1]
|
|
|
|
|
// 46 8b 24 22 mov r12d, DWORD PTR[rdx + r12 * 1]
|
|
|
|
|
// 8b 0c 02 mov ecx, DWORD PTR[rdx + rax * 1]
|
|
|
|
|
mov.is_load = true;
|
|
|
|
|
mov.byte_swap = false;
|
|
|
|
|
++i;
|
|
|
|
|
} else if (p[i] == 0xC7) {
|
|
|
|
|
// MOV m32, simm32
|
|
|
|
|
// http://www.asmpedia.org/index.php?title=MOV
|
|
|
|
|
// C7 04 02 02 00 00 00 mov dword ptr [rdx+rax],2
|
|
|
|
|
mov.is_load = false;
|
|
|
|
|
mov.byte_swap = false;
|
|
|
|
|
mov.is_constant = true;
|
|
|
|
|
++i;
|
|
|
|
|
} else {
|
|
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint8_t rex_b = rex & 0b0001;
|
|
|
|
|
uint8_t rex_x = rex & 0b0010;
|
|
|
|
|
uint8_t rex_r = rex & 0b0100;
|
|
|
|
|
uint8_t rex_w = rex & 0b1000;
|
|
|
|
|
|
|
|
|
|
// http://www.sandpile.org/x86/opc_rm.htm
|
|
|
|
|
// http://www.sandpile.org/x86/opc_sib.htm
|
|
|
|
|
uint8_t modrm = p[i++];
|
|
|
|
|
uint8_t mod = (modrm & 0b11000000) >> 6;
|
|
|
|
|
uint8_t reg = (modrm & 0b00111000) >> 3;
|
|
|
|
|
uint8_t rm = (modrm & 0b00000111);
|
|
|
|
|
mov.value_reg = reg + (rex_r ? 8 : 0);
|
|
|
|
|
mov.mem_has_base = false;
|
|
|
|
|
mov.mem_base_reg = 0;
|
|
|
|
|
mov.mem_has_index = false;
|
|
|
|
|
mov.mem_index_reg = 0;
|
|
|
|
|
mov.mem_scale = 1;
|
|
|
|
|
mov.mem_displacement = 0;
|
|
|
|
|
bool has_sib = false;
|
|
|
|
|
switch (rm) {
|
|
|
|
|
case 0b100: // SIB
|
|
|
|
|
has_sib = true;
|
|
|
|
|
break;
|
|
|
|
|
case 0b101:
|
|
|
|
|
if (mod == 0b00) {
|
|
|
|
|
// RIP-relative not supported.
|
|
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
mov.mem_has_base = true;
|
|
|
|
|
mov.mem_base_reg = rm + (rex_b ? 8 : 0);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
mov.mem_has_base = true;
|
|
|
|
|
mov.mem_base_reg = rm + (rex_b ? 8 : 0);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
if (has_sib) {
|
|
|
|
|
uint8_t sib = p[i++];
|
|
|
|
|
mov.mem_scale = 1 << ((sib & 0b11000000) >> 8);
|
|
|
|
|
uint8_t sib_index = (sib & 0b00111000) >> 3;
|
|
|
|
|
uint8_t sib_base = (sib & 0b00000111);
|
|
|
|
|
switch (sib_index) {
|
|
|
|
|
case 0b100:
|
|
|
|
|
// No index.
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
mov.mem_has_index = true;
|
|
|
|
|
mov.mem_index_reg = sib_index + (rex_x ? 8 : 0);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
switch (sib_base) {
|
|
|
|
|
case 0b101:
|
|
|
|
|
// Alternate rbp-relative addressing not supported.
|
|
|
|
|
assert_zero(mod);
|
|
|
|
|
return false;
|
|
|
|
|
default:
|
|
|
|
|
mov.mem_has_base = true;
|
|
|
|
|
mov.mem_base_reg = sib_base + (rex_b ? 8 : 0);
|
|
|
|
|
;
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
switch (mod) {
|
|
|
|
|
case 0b00: {
|
|
|
|
|
mov.mem_displacement += 0;
|
|
|
|
|
} break;
|
|
|
|
|
case 0b01: {
|
|
|
|
|
mov.mem_displacement += int8_t(p[i++]);
|
|
|
|
|
} break;
|
|
|
|
|
case 0b10: {
|
|
|
|
|
mov.mem_displacement += xe::load<int32_t>(p + i);
|
|
|
|
|
i += 4;
|
|
|
|
|
} break;
|
|
|
|
|
}
|
|
|
|
|
if (mov.is_constant) {
|
|
|
|
|
mov.constant = xe::load<int32_t>(p + i);
|
|
|
|
|
i += 4;
|
|
|
|
|
}
|
|
|
|
|
mov.length = i;
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool MMIOHandler::HandleAccessFault(void* thread_state,
|
|
|
|
|
uint64_t fault_address) {
|
|
|
|
|
if (fault_address < uint64_t(virtual_membase_)) {
|
|
|
|
|
@@ -230,94 +388,46 @@ bool MMIOHandler::HandleAccessFault(void* thread_state,
|
|
|
|
|
return CheckWriteWatch(thread_state, fault_address);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// TODO(benvanik): replace with simple check of mov (that's all
|
|
|
|
|
// we care about).
|
|
|
|
|
auto rip = GetThreadStateRip(thread_state);
|
|
|
|
|
BE::DISASM disasm = {0};
|
|
|
|
|
disasm.Archi = 64;
|
|
|
|
|
disasm.Options = BE::MasmSyntax + BE::PrefixedNumeral;
|
|
|
|
|
disasm.EIP = static_cast<BE::UIntPtr>(rip);
|
|
|
|
|
size_t instr_length = BE::Disasm(&disasm);
|
|
|
|
|
if (instr_length == BE::UNKNOWN_OPCODE) {
|
|
|
|
|
// Failed to decode instruction. Either it's an unhandled mov case or
|
|
|
|
|
// not a mov.
|
|
|
|
|
assert_always();
|
|
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int32_t arg1_type = disasm.Argument1.ArgType;
|
|
|
|
|
int32_t arg2_type = disasm.Argument2.ArgType;
|
|
|
|
|
bool is_load = (arg1_type & BE::REGISTER_TYPE) == BE::REGISTER_TYPE &&
|
|
|
|
|
(arg1_type & BE::GENERAL_REG) == BE::GENERAL_REG &&
|
|
|
|
|
(disasm.Argument1.AccessMode & BE::WRITE) == BE::WRITE;
|
|
|
|
|
bool is_store = (arg1_type & BE::MEMORY_TYPE) == BE::MEMORY_TYPE &&
|
|
|
|
|
(((arg2_type & BE::REGISTER_TYPE) == BE::REGISTER_TYPE &&
|
|
|
|
|
(arg2_type & BE::GENERAL_REG) == BE::GENERAL_REG) ||
|
|
|
|
|
(arg2_type & BE::CONSTANT_TYPE) == BE::CONSTANT_TYPE) &&
|
|
|
|
|
(disasm.Argument1.AccessMode & BE::WRITE) == BE::WRITE;
|
|
|
|
|
if (is_load) {
|
|
|
|
|
// Load of a memory value - read from range, swap, and store in the
|
|
|
|
|
// register.
|
|
|
|
|
uint64_t value = range->read(nullptr, range->callback_context,
|
|
|
|
|
fault_address & 0xFFFFFFFF);
|
|
|
|
|
uint32_t be_reg_index;
|
|
|
|
|
if (!xe::bit_scan_forward(arg1_type & 0xFFFF, &be_reg_index)) {
|
|
|
|
|
be_reg_index = 0;
|
|
|
|
|
}
|
|
|
|
|
uint64_t* reg_ptr = GetThreadStateRegPtr(thread_state, be_reg_index);
|
|
|
|
|
switch (disasm.Argument1.ArgSize) {
|
|
|
|
|
case 8:
|
|
|
|
|
*reg_ptr = static_cast<uint8_t>(value);
|
|
|
|
|
break;
|
|
|
|
|
case 16:
|
|
|
|
|
*reg_ptr = xe::byte_swap(static_cast<uint16_t>(value));
|
|
|
|
|
break;
|
|
|
|
|
case 32:
|
|
|
|
|
*reg_ptr = xe::byte_swap(static_cast<uint32_t>(value));
|
|
|
|
|
break;
|
|
|
|
|
case 64:
|
|
|
|
|
*reg_ptr = xe::byte_swap(static_cast<uint64_t>(value));
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
} else if (is_store) {
|
|
|
|
|
// Store of a register value - read register, swap, write to range.
|
|
|
|
|
uint64_t value = 0;
|
|
|
|
|
if ((arg2_type & BE::REGISTER_TYPE) == BE::REGISTER_TYPE) {
|
|
|
|
|
uint32_t be_reg_index;
|
|
|
|
|
if (!xe::bit_scan_forward(arg2_type & 0xFFFF, &be_reg_index)) {
|
|
|
|
|
be_reg_index = 0;
|
|
|
|
|
}
|
|
|
|
|
uint64_t* reg_ptr = GetThreadStateRegPtr(thread_state, be_reg_index);
|
|
|
|
|
value = *reg_ptr;
|
|
|
|
|
} else if ((arg2_type & BE::CONSTANT_TYPE) == BE::CONSTANT_TYPE) {
|
|
|
|
|
value = disasm.Instruction.Immediat;
|
|
|
|
|
} else {
|
|
|
|
|
// Unknown destination type in mov.
|
|
|
|
|
assert_always();
|
|
|
|
|
}
|
|
|
|
|
switch (disasm.Argument2.ArgSize) {
|
|
|
|
|
case 8:
|
|
|
|
|
value = static_cast<uint8_t>(value);
|
|
|
|
|
break;
|
|
|
|
|
case 16:
|
|
|
|
|
value = xe::byte_swap(static_cast<uint16_t>(value));
|
|
|
|
|
break;
|
|
|
|
|
case 32:
|
|
|
|
|
value = xe::byte_swap(static_cast<uint32_t>(value));
|
|
|
|
|
break;
|
|
|
|
|
case 64:
|
|
|
|
|
value = xe::byte_swap(static_cast<uint64_t>(value));
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
range->write(nullptr, range->callback_context, fault_address & 0xFFFFFFFF,
|
|
|
|
|
value);
|
|
|
|
|
} else {
|
|
|
|
|
auto p = reinterpret_cast<const uint8_t*>(rip);
|
|
|
|
|
DecodedMov mov = {0};
|
|
|
|
|
bool decoded = TryDecodeMov(p, mov);
|
|
|
|
|
if (!decoded) {
|
|
|
|
|
XELOGE("Unable to decode MMIO mov at %p", p);
|
|
|
|
|
assert_always("Unknown MMIO instruction type");
|
|
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (mov.is_load) {
|
|
|
|
|
// Load of a memory value - read from range, swap, and store in the
|
|
|
|
|
// register.
|
|
|
|
|
uint32_t value = range->read(nullptr, range->callback_context,
|
|
|
|
|
fault_address & 0xFFFFFFFF);
|
|
|
|
|
uint64_t* reg_ptr = GetThreadStateRegPtr(thread_state, mov.value_reg);
|
|
|
|
|
if (!mov.byte_swap) {
|
|
|
|
|
// We swap only if it's not a movbe, as otherwise we are swapping twice.
|
|
|
|
|
value = xe::byte_swap(value);
|
|
|
|
|
}
|
|
|
|
|
*reg_ptr = value;
|
|
|
|
|
} else {
|
|
|
|
|
// Store of a register value - read register, swap, write to range.
|
|
|
|
|
int32_t value;
|
|
|
|
|
if (mov.is_constant) {
|
|
|
|
|
value = uint32_t(mov.constant);
|
|
|
|
|
} else {
|
|
|
|
|
uint64_t* reg_ptr = GetThreadStateRegPtr(thread_state, mov.value_reg);
|
|
|
|
|
value = static_cast<uint32_t>(*reg_ptr);
|
|
|
|
|
if (!mov.byte_swap) {
|
|
|
|
|
// We swap only if it's not a movbe, as otherwise we are swapping twice.
|
|
|
|
|
value = xe::byte_swap(static_cast<uint32_t>(value));
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
range->write(nullptr, range->callback_context, fault_address & 0xFFFFFFFF,
|
|
|
|
|
value);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Advance RIP to the next instruction so that we resume properly.
|
|
|
|
|
SetThreadStateRip(thread_state, rip + instr_length);
|
|
|
|
|
SetThreadStateRip(thread_state, rip + mov.length);
|
|
|
|
|
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|