rpcsx/rpcs3/Emu/ARMv7/ARMv7Interpreter.h

#pragma once
#include "Emu/ARMv7/ARMv7Opcodes.h"

class ARMv7Interpreter : public ARMv7Opcodes
{
	ARMv7Thread& CPU;

public:
	ARMv7Interpreter(ARMv7Thread& cpu) : CPU(cpu)
	{
	}

	enum SRType : u32
	{
		SRType_None,
		SRType_LSL,
		SRType_LSR,
		SRType_ASR,
		SRType_ROR,
		SRType_RRX,
	};

	template<typename T>
	bool IsZero(T x)
	{
		return x == T(0);
	}

	template<typename T>
	bool IsOnes(T x)
	{
		return x == ~T(0);
	}

	template<typename T>
	u8 IsZeroBit(T x)
	{
		return IsZero(x) ? 1 : 0;
	}

	template<typename T>
	bool IsOnesBit(T x, u8 len = sizeof(T) * 8)
	{
		return IsOnes(x) ? 1 : 0;
	}

	template<typename T>
	u8 BitCount(T x, u8 len = sizeof(T) * 8)
	{
		u8 result = 0;

		for(u8 mask=1 << (len - 1); mask; mask >>= 1)
		{
			if(x & mask) result++;
		}

		return result;
	}

	template<typename T>
	s8 LowestSetBit(T x, u8 len = sizeof(T) * 8)
	{
		if(!x) return len;

		u8 result = 0;

		for(T mask=1, i=0; i<len && (x & mask) == 0; mask <<= 1, i++)
		{
			result++;
		}

		return result;
	}

	template<typename T>
	s8 HighestSetBit(T x, u8 len = sizeof(T) * 8)
	{
		if(!x) return -1;

		u8 result = len;

		for(T mask=T(1) << (len - 1); (x & mask) == 0; mask >>= 1)
		{
			result--;
		}

		return result;
	}

	template<typename T>
	s8 CountLeadingZeroBits(T x, u8 len = sizeof(T) * 8)
	{
		return len - 1 - HighestSetBit(x, len);
	}

	SRType DecodeImmShift(u32 type, u32 imm5, u32* shift_n)
	{
		SRType shift_t = SRType_None;

		switch(type)
		{
		case 0: shift_t = SRType_LSL; if(shift_n) *shift_n = imm5; break;
		case 1: shift_t = SRType_LSR; if(shift_n) *shift_n = imm5 == 0 ? 32 : imm5; break;
		case 2: shift_t = SRType_ASR; if(shift_n) *shift_n = imm5 == 0 ? 32 : imm5; break;
		case 3:
			if(imm5 == 0)
			{
				shift_t = SRType_RRX; if(shift_n) *shift_n = 1;
			}
			else
			{
				shift_t = SRType_ROR; if(shift_n) *shift_n = imm5;
			}
		break;
		}

		return shift_t;
	}

	SRType DecodeRegShift(u8 type)
	{
		SRType shift_t = SRType_None;

		switch(type)
		{
		case 0: shift_t = SRType_LSL; break;
		case 1: shift_t = SRType_LSR; break;
		case 2: shift_t = SRType_ASR; break;
		case 3: shift_t = SRType_ROR; break;
		}

		return shift_t;
	}

	u32 LSL_C(u32 x, s32 shift, bool& carry_out)
	{
		assert(shift > 0);
		carry_out = shift <= 32 ? x & (1 << (32 - shift)) : false;
		return shift < 32 ? x << shift : 0;
	}

	u32 LSL(u32 x, s32 shift)
	{
		assert(shift >= 0);
		return shift < 32 ? x << shift : 0;
	}

	u32 LSR_C(u32 x, s32 shift, bool& carry_out)
	{
		assert(shift > 0);
		carry_out = shift <= 32 ? x & (1 << (shift - 1)) : false;
		return shift < 32 ? x >> shift : 0;
	}

	u32 LSR(u32 x, s32 shift)
	{
		assert(shift >= 0);
		return shift < 32 ? x >> shift : 0;
	}

	s32 ASR_C(s32 x, s32 shift, bool& carry_out)
	{
		assert(shift > 0);
		carry_out = shift <= 32 ? x & (1 << (shift - 1)) : false;
		return shift < 32 ? x >> shift : x >> 31;
	}

	s32 ASR(s32 x, s32 shift)
	{
		assert(shift >= 0);
		return shift < 32 ? x >> shift : x >> 31;
	}

	u32 ROR_C(u32 x, s32 shift, bool& carry_out)
	{
		assert(shift);
		carry_out = x & (1 << (shift - 1));
		return x >> shift | x << (32 - shift);
	}

	u32 ROR(u32 x, s32 shift)
	{
		return x >> shift | x << (32 - shift);
	}

	u32 RRX_C(u32 x, bool carry_in, bool& carry_out)
	{
		carry_out = x & 0x1;
		return ((u32)carry_in << 31) | (x >> 1);
	}

	u32 RRX(u32 x, bool carry_in)
	{
		return ((u32)carry_in << 31) | (x >> 1);
	}

	template<typename T> T Shift_C(T value, SRType type, s32 amount, bool carry_in, bool& carry_out)
	{
		assert(type != SRType_RRX || amount == 1);

		if(amount)
		{
			switch(type)
			{
			case SRType_LSL: return LSL_C(value, amount, carry_out);
			case SRType_LSR: return LSR_C(value, amount, carry_out);
			case SRType_ASR: return ASR_C(value, amount, carry_out);
			case SRType_ROR: return ROR_C(value, amount, carry_out);
			case SRType_RRX: return RRX_C(value, carry_in, carry_out);
			}
		}

		carry_out = carry_in;
		return value;
	}

	template<typename T> T Shift(T value, SRType type, s32 amount, bool carry_in)
	{
		bool carry_out;
		return Shift_C(value, type, amount, carry_in, carry_out);
	}

	template<typename T> T AddWithCarry(T x, T y, bool carry_in, bool& carry_out, bool& overflow)
	{
		const T sign_mask = (T)1 << (sizeof(T) - 1);

		T result = x + y;
		carry_out = ((x & y) | ((x ^ y) & ~result)) & sign_mask;
		overflow = (x ^ result) & (y ^ result) & sign_mask;
		if (carry_in)
		{
			result += 1;
			carry_out ^= (result == 0);
			overflow ^= (result == sign_mask);
		}
		return result;
	}

	u32 ThumbExpandImm_C(u32 imm12, bool carry_in, bool& carry_out)
	{
		if ((imm12 & 0xc00) >> 10)
		{
			u32 unrotated_value = (imm12 & 0x7f) | 0x80;

			return ROR_C(unrotated_value, (imm12 & 0xf80) >> 7, carry_out);
		}
		else
		{
			carry_out = carry_in;

			u32 imm8 = imm12 & 0xff;
			switch ((imm12 & 0x300) >> 8)
			{
			case 0: return imm8;
			case 1: return imm8 << 16 | imm8;
			case 2: return imm8 << 24 | imm8 << 8;
			default: return imm8 << 24 | imm8 << 16 | imm8 << 8 | imm8;
			}
		}
	}

	u32 ThumbExpandImm(u32 imm12)
	{
		bool carry = CPU.APSR.C;
		return ThumbExpandImm_C(imm12, carry, carry);
	}

	bool ConditionPassed(u32 cond) const
	{
		bool result = false;

		switch(cond >> 1)
		{
		case 0: result = CPU.APSR.Z == 1; break;
		case 1: result = CPU.APSR.C == 1; break;
		case 2: result = CPU.APSR.N == 1; break;
		case 3: result = CPU.APSR.V == 1; break;
		case 4: result = CPU.APSR.C == 1 && CPU.APSR.Z == 0; break;
		case 5: result = CPU.APSR.N == CPU.APSR.V; break;
		case 6: result = CPU.APSR.N == CPU.APSR.V && CPU.APSR.Z == 0; break;
		case 7: return true;
		}

		if(cond & 0x1)
		{
			return !result;
		}

		return result;
	}

protected:
	virtual void UNK(const u32 data);

	virtual void NULL_OP(const u32 data, const ARMv7_encoding type);

	virtual void HACK(const u32 data, const ARMv7_encoding type);

	virtual void ADC_IMM(const u32 data, const ARMv7_encoding type);
	virtual void ADC_REG(const u32 data, const ARMv7_encoding type);
	virtual void ADC_RSR(const u32 data, const ARMv7_encoding type);

	virtual void ADD_IMM(const u32 data, const ARMv7_encoding type);
	virtual void ADD_REG(const u32 data, const ARMv7_encoding type);
	virtual void ADD_RSR(const u32 data, const ARMv7_encoding type);
	virtual void ADD_SPI(const u32 data, const ARMv7_encoding type);
	virtual void ADD_SPR(const u32 data, const ARMv7_encoding type);

	virtual void ADR(const u32 data, const ARMv7_encoding type);

	virtual void AND_IMM(const u32 data, const ARMv7_encoding type);
	virtual void AND_REG(const u32 data, const ARMv7_encoding type);
	virtual void AND_RSR(const u32 data, const ARMv7_encoding type);

	virtual void ASR_IMM(const u32 data, const ARMv7_encoding type);
	virtual void ASR_REG(const u32 data, const ARMv7_encoding type);

	virtual void B(const u32 data, const ARMv7_encoding type);

	virtual void BFC(const u32 data, const ARMv7_encoding type);
	virtual void BFI(const u32 data, const ARMv7_encoding type);

	virtual void BIC_IMM(const u32 data, const ARMv7_encoding type);
	virtual void BIC_REG(const u32 data, const ARMv7_encoding type);
	virtual void BIC_RSR(const u32 data, const ARMv7_encoding type);

	virtual void BKPT(const u32 data, const ARMv7_encoding type);

	virtual void BL(const u32 data, const ARMv7_encoding type);
	virtual void BLX(const u32 data, const ARMv7_encoding type);
	virtual void BX(const u32 data, const ARMv7_encoding type);

	virtual void CB_Z(const u32 data, const ARMv7_encoding type);

	virtual void CLZ(const u32 data, const ARMv7_encoding type);

	virtual void CMN_IMM(const u32 data, const ARMv7_encoding type);
	virtual void CMN_REG(const u32 data, const ARMv7_encoding type);
	virtual void CMN_RSR(const u32 data, const ARMv7_encoding type);

	virtual void CMP_IMM(const u32 data, const ARMv7_encoding type);
	virtual void CMP_REG(const u32 data, const ARMv7_encoding type);
	virtual void CMP_RSR(const u32 data, const ARMv7_encoding type);

	virtual void EOR_IMM(const u32 data, const ARMv7_encoding type);
	virtual void EOR_REG(const u32 data, const ARMv7_encoding type);
	virtual void EOR_RSR(const u32 data, const ARMv7_encoding type);

	virtual void IT(const u32 data, const ARMv7_encoding type);

	virtual void LDM(const u32 data, const ARMv7_encoding type);
	virtual void LDMDA(const u32 data, const ARMv7_encoding type);
	virtual void LDMDB(const u32 data, const ARMv7_encoding type);
	virtual void LDMIB(const u32 data, const ARMv7_encoding type);

	virtual void LDR_IMM(const u32 data, const ARMv7_encoding type);
	virtual void LDR_LIT(const u32 data, const ARMv7_encoding type);
	virtual void LDR_REG(const u32 data, const ARMv7_encoding type);

	virtual void LDRB_IMM(const u32 data, const ARMv7_encoding type);
	virtual void LDRB_LIT(const u32 data, const ARMv7_encoding type);
	virtual void LDRB_REG(const u32 data, const ARMv7_encoding type);

	virtual void LDRD_IMM(const u32 data, const ARMv7_encoding type);
	virtual void LDRD_LIT(const u32 data, const ARMv7_encoding type);
	virtual void LDRD_REG(const u32 data, const ARMv7_encoding type);

	virtual void LDRH_IMM(const u32 data, const ARMv7_encoding type);
	virtual void LDRH_LIT(const u32 data, const ARMv7_encoding type);
	virtual void LDRH_REG(const u32 data, const ARMv7_encoding type);

	virtual void LDRSB_IMM(const u32 data, const ARMv7_encoding type);
	virtual void LDRSB_LIT(const u32 data, const ARMv7_encoding type);
	virtual void LDRSB_REG(const u32 data, const ARMv7_encoding type);

	virtual void LDRSH_IMM(const u32 data, const ARMv7_encoding type);
	virtual void LDRSH_LIT(const u32 data, const ARMv7_encoding type);
	virtual void LDRSH_REG(const u32 data, const ARMv7_encoding type);

	virtual void LSL_IMM(const u32 data, const ARMv7_encoding type);
	virtual void LSL_REG(const u32 data, const ARMv7_encoding type);

	virtual void LSR_IMM(const u32 data, const ARMv7_encoding type);
	virtual void LSR_REG(const u32 data, const ARMv7_encoding type);

	virtual void MLA(const u32 data, const ARMv7_encoding type);
	virtual void MLS(const u32 data, const ARMv7_encoding type);

	virtual void MOV_IMM(const u32 data, const ARMv7_encoding type);
	virtual void MOV_REG(const u32 data, const ARMv7_encoding type);
	virtual void MOVT(const u32 data, const ARMv7_encoding type);

	virtual void MRS(const u32 data, const ARMv7_encoding type);
	virtual void MSR_IMM(const u32 data, const ARMv7_encoding type);
	virtual void MSR_REG(const u32 data, const ARMv7_encoding type);

	virtual void MUL(const u32 data, const ARMv7_encoding type);

	virtual void MVN_IMM(const u32 data, const ARMv7_encoding type);
	virtual void MVN_REG(const u32 data, const ARMv7_encoding type);
	virtual void MVN_RSR(const u32 data, const ARMv7_encoding type);

	virtual void NOP(const u32 data, const ARMv7_encoding type);

	virtual void ORN_IMM(const u32 data, const ARMv7_encoding type);
	virtual void ORN_REG(const u32 data, const ARMv7_encoding type);

	virtual void ORR_IMM(const u32 data, const ARMv7_encoding type);
	virtual void ORR_REG(const u32 data, const ARMv7_encoding type);
	virtual void ORR_RSR(const u32 data, const ARMv7_encoding type);

	virtual void PKH(const u32 data, const ARMv7_encoding type);

	virtual void POP(const u32 data, const ARMv7_encoding type);
	virtual void PUSH(const u32 data, const ARMv7_encoding type);

	virtual void QADD(const u32 data, const ARMv7_encoding type);
	virtual void QADD16(const u32 data, const ARMv7_encoding type);
	virtual void QADD8(const u32 data, const ARMv7_encoding type);
	virtual void QASX(const u32 data, const ARMv7_encoding type);
	virtual void QDADD(const u32 data, const ARMv7_encoding type);
	virtual void QDSUB(const u32 data, const ARMv7_encoding type);
	virtual void QSAX(const u32 data, const ARMv7_encoding type);
	virtual void QSUB(const u32 data, const ARMv7_encoding type);
	virtual void QSUB16(const u32 data, const ARMv7_encoding type);
	virtual void QSUB8(const u32 data, const ARMv7_encoding type);

	virtual void RBIT(const u32 data, const ARMv7_encoding type);
	virtual void REV(const u32 data, const ARMv7_encoding type);
	virtual void REV16(const u32 data, const ARMv7_encoding type);
	virtual void REVSH(const u32 data, const ARMv7_encoding type);

	virtual void ROR_IMM(const u32 data, const ARMv7_encoding type);
	virtual void ROR_REG(const u32 data, const ARMv7_encoding type);

	virtual void RRX(const u32 data, const ARMv7_encoding type);

	virtual void RSB_IMM(const u32 data, const ARMv7_encoding type);
	virtual void RSB_REG(const u32 data, const ARMv7_encoding type);
	virtual void RSB_RSR(const u32 data, const ARMv7_encoding type);

	virtual void RSC_IMM(const u32 data, const ARMv7_encoding type);
	virtual void RSC_REG(const u32 data, const ARMv7_encoding type);
	virtual void RSC_RSR(const u32 data, const ARMv7_encoding type);

	virtual void SADD16(const u32 data, const ARMv7_encoding type);
	virtual void SADD8(const u32 data, const ARMv7_encoding type);
	virtual void SASX(const u32 data, const ARMv7_encoding type);

	virtual void SBC_IMM(const u32 data, const ARMv7_encoding type);
	virtual void SBC_REG(const u32 data, const ARMv7_encoding type);
	virtual void SBC_RSR(const u32 data, const ARMv7_encoding type);

	virtual void SBFX(const u32 data, const ARMv7_encoding type);

	virtual void SDIV(const u32 data, const ARMv7_encoding type);

	virtual void SEL(const u32 data, const ARMv7_encoding type);

	virtual void SHADD16(const u32 data, const ARMv7_encoding type);
	virtual void SHADD8(const u32 data, const ARMv7_encoding type);
	virtual void SHASX(const u32 data, const ARMv7_encoding type);
	virtual void SHSAX(const u32 data, const ARMv7_encoding type);
	virtual void SHSUB16(const u32 data, const ARMv7_encoding type);
	virtual void SHSUB8(const u32 data, const ARMv7_encoding type);

	virtual void SMLA__(const u32 data, const ARMv7_encoding type);
	virtual void SMLAD(const u32 data, const ARMv7_encoding type);
	virtual void SMLAL(const u32 data, const ARMv7_encoding type);
	virtual void SMLAL__(const u32 data, const ARMv7_encoding type);
	virtual void SMLALD(const u32 data, const ARMv7_encoding type);
	virtual void SMLAW_(const u32 data, const ARMv7_encoding type);
	virtual void SMLSD(const u32 data, const ARMv7_encoding type);
	virtual void SMLSLD(const u32 data, const ARMv7_encoding type);
	virtual void SMMLA(const u32 data, const ARMv7_encoding type);
	virtual void SMMLS(const u32 data, const ARMv7_encoding type);
	virtual void SMMUL(const u32 data, const ARMv7_encoding type);
	virtual void SMUAD(const u32 data, const ARMv7_encoding type);
	virtual void SMUL__(const u32 data, const ARMv7_encoding type);
	virtual void SMULL(const u32 data, const ARMv7_encoding type);
	virtual void SMULW_(const u32 data, const ARMv7_encoding type);
	virtual void SMUSD(const u32 data, const ARMv7_encoding type);

	virtual void SSAT(const u32 data, const ARMv7_encoding type);
	virtual void SSAT16(const u32 data, const ARMv7_encoding type);
	virtual void SSAX(const u32 data, const ARMv7_encoding type);
	virtual void SSUB16(const u32 data, const ARMv7_encoding type);
	virtual void SSUB8(const u32 data, const ARMv7_encoding type);

	virtual void STM(const u32 data, const ARMv7_encoding type);
	virtual void STMDA(const u32 data, const ARMv7_encoding type);
	virtual void STMDB(const u32 data, const ARMv7_encoding type);
	virtual void STMIB(const u32 data, const ARMv7_encoding type);

	virtual void STR_IMM(const u32 data, const ARMv7_encoding type);
	virtual void STR_REG(const u32 data, const ARMv7_encoding type);

	virtual void STRB_IMM(const u32 data, const ARMv7_encoding type);
	virtual void STRB_REG(const u32 data, const ARMv7_encoding type);

	virtual void STRD_IMM(const u32 data, const ARMv7_encoding type);
	virtual void STRD_REG(const u32 data, const ARMv7_encoding type);

	virtual void STRH_IMM(const u32 data, const ARMv7_encoding type);
	virtual void STRH_REG(const u32 data, const ARMv7_encoding type);

	virtual void SUB_IMM(const u32 data, const ARMv7_encoding type);
	virtual void SUB_REG(const u32 data, const ARMv7_encoding type);
	virtual void SUB_RSR(const u32 data, const ARMv7_encoding type);
	virtual void SUB_SPI(const u32 data, const ARMv7_encoding type);
	virtual void SUB_SPR(const u32 data, const ARMv7_encoding type);

	virtual void SVC(const u32 data, const ARMv7_encoding type);

	virtual void SXTAB(const u32 data, const ARMv7_encoding type);
	virtual void SXTAB16(const u32 data, const ARMv7_encoding type);
	virtual void SXTAH(const u32 data, const ARMv7_encoding type);
	virtual void SXTB(const u32 data, const ARMv7_encoding type);
	virtual void SXTB16(const u32 data, const ARMv7_encoding type);
	virtual void SXTH(const u32 data, const ARMv7_encoding type);

	virtual void TB_(const u32 data, const ARMv7_encoding type);

	virtual void TEQ_IMM(const u32 data, const ARMv7_encoding type);
	virtual void TEQ_REG(const u32 data, const ARMv7_encoding type);
	virtual void TEQ_RSR(const u32 data, const ARMv7_encoding type);

	virtual void TST_IMM(const u32 data, const ARMv7_encoding type);
	virtual void TST_REG(const u32 data, const ARMv7_encoding type);
	virtual void TST_RSR(const u32 data, const ARMv7_encoding type);

	virtual void UADD16(const u32 data, const ARMv7_encoding type);
	virtual void UADD8(const u32 data, const ARMv7_encoding type);
	virtual void UASX(const u32 data, const ARMv7_encoding type);
	virtual void UBFX(const u32 data, const ARMv7_encoding type);
	virtual void UDIV(const u32 data, const ARMv7_encoding type);
	virtual void UHADD16(const u32 data, const ARMv7_encoding type);
	virtual void UHADD8(const u32 data, const ARMv7_encoding type);
	virtual void UHASX(const u32 data, const ARMv7_encoding type);
	virtual void UHSAX(const u32 data, const ARMv7_encoding type);
	virtual void UHSUB16(const u32 data, const ARMv7_encoding type);
	virtual void UHSUB8(const u32 data, const ARMv7_encoding type);
	virtual void UMAAL(const u32 data, const ARMv7_encoding type);
	virtual void UMLAL(const u32 data, const ARMv7_encoding type);
	virtual void UMULL(const u32 data, const ARMv7_encoding type);
	virtual void UQADD16(const u32 data, const ARMv7_encoding type);
	virtual void UQADD8(const u32 data, const ARMv7_encoding type);
	virtual void UQASX(const u32 data, const ARMv7_encoding type);
	virtual void UQSAX(const u32 data, const ARMv7_encoding type);
	virtual void UQSUB16(const u32 data, const ARMv7_encoding type);
	virtual void UQSUB8(const u32 data, const ARMv7_encoding type);
	virtual void USAD8(const u32 data, const ARMv7_encoding type);
	virtual void USADA8(const u32 data, const ARMv7_encoding type);
	virtual void USAT(const u32 data, const ARMv7_encoding type);
	virtual void USAT16(const u32 data, const ARMv7_encoding type);
	virtual void USAX(const u32 data, const ARMv7_encoding type);
	virtual void USUB16(const u32 data, const ARMv7_encoding type);
	virtual void USUB8(const u32 data, const ARMv7_encoding type);
	virtual void UXTAB(const u32 data, const ARMv7_encoding type);
	virtual void UXTAB16(const u32 data, const ARMv7_encoding type);
	virtual void UXTAH(const u32 data, const ARMv7_encoding type);
	virtual void UXTB(const u32 data, const ARMv7_encoding type);
	virtual void UXTB16(const u32 data, const ARMv7_encoding type);
	virtual void UXTH(const u32 data, const ARMv7_encoding type);
};