Instruction32.cpp

#include <iostream>
using namespace std;

#include "Emulator.h"
#include "ModRM.h"

instruction_func_t* instructions32[256];

namespace instruction32{

// 圧倒的NOP
void nop(Emulator *emu){
	emu->EIP++;
}

void add_rm32_r32(Emulator *emu){
	emu->EIP++;
	ModRM modrm(emu);
	uint32_t r32 = modrm.GetR32();
	uint32_t rm32 = modrm.GetRM32();
	modrm.SetRM32(rm32 + r32);
}

void mov_rm8_r8(Emulator *emu){
	emu->EIP++;
	ModRM modrm(emu);
	uint32_t r8 = modrm.GetR8();
	modrm.SetRM8(r8);
}

void mov_r8_imm8(Emulator *emu){
	uint8_t reg = emu->GetCode8(0) - 0xB0;
	emu->reg[reg].reg32 = emu->GetCode8(1);
	emu->EIP += 2;
//	std::cout<<"a";
}

void mov_r32_imm32(Emulator *emu){
	uint8_t reg	= emu->GetCode8(0) - 0xB8;
	uint32_t val	= emu->GetCode8(1);
	emu->reg[reg].reg32 = val;
	emu->EIP += 5;
}

void mov_r8_rm8(Emulator *emu){//		cout<<"mov_r8_rm8"<<endl;
	emu->EIP++;
	ModRM modrm(emu);
	uint32_t rm8 = modrm.GetRM8();
	modrm.SetR8(rm8);
}

void mov_r32_rm32(Emulator *emu){
	emu->EIP++;
	ModRM modrm(emu);
	uint32_t rm32 = modrm.GetRM32();
	modrm.SetR32(rm32);
}

void inc_r32(Emulator *emu){
	uint8_t reg = emu->GetCode8(0) - 0x40;
	emu->reg[reg].reg32++;
	emu->EIP++;
}

void add_rm32_imm8(Emulator *emu, ModRM *modrm){
	uint32_t rm32 = modrm->GetRM32(emu);
	uint32_t imm8 = (int32_t)emu->GetSignCode8(0);
	emu->EIP++;
	modrm->SetRM32(emu, rm32 + imm8);
}

void mov_rm32_imm32(Emulator *emu){
	emu->EIP++;
	ModRM modrm(emu);
	uint32_t val = emu->GetCode32(0);
	emu->EIP+=4;
	modrm.SetRM32(val);		cout<<"mov val="<<val<<endl;
}

void mov_rm32_r32(Emulator *emu){	//cout<<"mov2"<<endl;
	emu->EIP++;
	ModRM modrm(emu);
	uint32_t r32 = modrm.GetR32();
	modrm.SetRM32(r32);
}

/*
void in_al_dx(Emulator *emu){
	uint16_t addr = emu->EDX & 0xffff;
	uint8_t val = io_in8(addr);
	
}
*/
void short_jump(Emulator *emu){
	int8_t diff = emu->GetSignCode8(1);
	emu->EIP += (diff + 2);
}

void near_jump(Emulator *emu){
	int32_t diff = emu->GetSignCode32(1);
	emu->EIP += (diff + 5);
}

void sub_rm32_imm8(Emulator *emu, ModRM *modrm){
	uint32_t rm32 = modrm->GetRM32();
	uint32_t imm8 = (int32_t)emu->GetSignCode8(0);
	emu->EIP++;
	modrm->SetRM32(rm32 - imm8);
}

void code_83(Emulator *emu){
	emu->EIP++;
	ModRM *modrm = new ModRM(emu);
	
	switch(modrm->opecode){
		case 0:
			add_rm32_imm8(emu, modrm);
		case 5:
			sub_rm32_imm8(emu, modrm);
			break;
		default:
			cout<<"not implemented: 83 "<<(uint32_t)modrm->opecode<<endl;
			
	}
	delete modrm;
}

void push_r32(Emulator *emu){
	uint8_t reg = emu->GetCode8(0) - 0x50;
	emu->Push32(emu->GetRegister32(reg));
	emu->EIP++;
}

void pop_r32(Emulator *emu){
	uint8_t reg = emu->GetCode8(0) - 0x58;
	emu->SetRegister32(reg, emu->Pop32());
	emu->EIP++;
}

void push_imm8(Emulator *emu){
	uint32_t val = emu->GetCode32(1);
	emu->Push32(val);
	emu->EIP += 2;
}

void inc_rm32(Emulator *emu, ModRM *modrm){
	uint32_t val = modrm->GetRM32();
	modrm->SetRM32(val + 1);
}

void code_ff(Emulator *emu){
	emu->EIP++;
	ModRM *modrm = new ModRM(emu);
	
	switch(modrm->opecode){
	case 0:
		inc_rm32(emu, modrm);
		break;
	default:
		cout<<"not implemented: 0xFF /"<<(int)modrm->opecode<<endl;
	}
	
	delete modrm;
}

void call_rel32(Emulator *emu){
	int32_t diff = emu->GetSignCode32(1);
	emu->Push32(emu->EIP + 5);	//call命令は全体で5バイト
	emu->EIP += (diff + 5);
}

void ret(Emulator *emu){//	cout<<"ret"<<endl;
	emu->EIP = emu->Pop32();
}

void leave(Emulator *emu){
//	uint32_t ebp = EBP;
	emu->ESP = emu->EBP;
	emu->EBP = emu->Pop32();
	emu->EIP++;
}


// defineでJなんとか関数を大量錬成する
#define DEFINE_JX(flag, is_flag) \
void j ## flag(Emulator *emu){ \
	int diff = emu->is_flag() ? emu->GetSignCode8(1) : 0; \
	emu->EIP += (diff + 2); \
} \
void jn ## flag(Emulator *emu){ \
	int diff = emu->is_flag() ? 0 : emu->GetSignCode8(1); \
	emu->EIP += (diff + 2); \
}

DEFINE_JX(c, IsCarry);
DEFINE_JX(z, IsZero);
DEFINE_JX(s, IsSign);
DEFINE_JX(o, IsOverflow)

#undef DEFINE_JX

void cmp_r32_rm32(Emulator *emu){
	emu->EIP++;
	ModRM *modrm = new ModRM(emu);
	uint32_t r32 = modrm->GetR32();
	uint32_t rm32= modrm->GetRM32();
	uint64_t result = (uint64_t)r32 - (uint64_t)rm32; //32bit目を観測したいから64bitとして扱う
	emu->UpdateEflagsSub(r32, rm32, result);
	delete modrm;
}

void jl(Emulator *emu){
	int diff = (emu->IsSign() != emu->IsOverflow()) ? emu->GetSignCode8(1) : 0;
	emu->EIP += (diff + 2);
}

void jle(Emulator *emu){
	int diff = (emu->IsZero() || (emu->IsSign() != emu->IsOverflow())) ? emu->GetSignCode8(1) : 0;
	emu->EIP += (diff + 2);
}

} // namespace instruction32



using namespace instruction32;

void InitInstructions32(void){
	int i;
	instruction_func_t** func = instructions32;
	
	func[0x01]	= add_rm32_r32;
	
	func[0x3B]	= cmp_r32_rm32;
	//func[0x3C]	= cmp_al_imm8;
	//func[0x3D]	= cmp_eax_imm32;
	
	
	for(i=0;i<8;i++){
		func[0x40 + i]	= inc_r32;
	}
	
	
	
	for(i=0;i<8;i++){
		func[0x50 + i]	= push_r32;
	}
	
	
	
	for(i=0;i<8;i++){
		func[0x58 + i]	= pop_r32;
	}
	
	
	
	//func[0x68]	= push_imm32;
	func[0x6A]	= push_imm8;
	
	func[0x70]	= jo;
	func[0x71]	= jno;
	func[0x72]	= jc;
	func[0x73]	= jnc;
	func[0x74]	= jz;
	func[0x75]	= jnz;
	func[0x78]	= js;
	func[0x79]	= jns;
	func[0x7C]	= jl;
	func[0x7E]	= jle;
	
	func[0x83]	= code_83;
	func[0x88]	= mov_rm8_r8;
	func[0x89]	= mov_rm32_r32;
	//func[0x8A]	= mov_r8_rm8;
	func[0x8B]	= mov_r32_rm32;

	func[0x90]	= nop;

	for(i=0;i<8;i++){
		func[0xB0 + i]	= mov_r8_imm8;
	}
	
	for(i=0;i<8;i++){
		func[0xB8 + i]	= mov_r32_imm32;
	}
	
	func[0xC3]	= ret;
	func[0xC7]	= mov_rm32_imm32;
	func[0xC9]	= leave;
	
	//func[0xCD]	= swi;
	
	func[0xE8]	= call_rel32;
	func[0xE9]	= near_jump;
	func[0xEB]	= short_jump;
	//func[0xEC]	= in_al_dx;
	//func[0xEE]	= out_dx_al;
	func[0xFF]	= code_ff;
}