#include "stdafx.h"
#include "Emu/System.h"
#include "Emu/Memory/Memory.h"
#include "Emu/CPU/CPUDecoder.h"
#include "ARMv7Thread.h"
#include "PSVFuncList.h"
#include "ARMv7Interpreter.h"

void ARMv7Interpreter::UNK(const u32 data)
{
	LOG_ERROR(HLE, "Unknown/illegal opcode! (0x%04x : 0x%04x)", data >> 16, data & 0xffff);
	Emu.Pause();
}

void ARMv7Interpreter::NULL_OP(const u32 data, const ARMv7_encoding type)
{
	LOG_ERROR(HLE, "Null opcode found");
	Emu.Pause();
}

void ARMv7Interpreter::HACK(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 code = 0;

	switch (type)
	{
	case T1:
	{
		code = data & 0xffff;
		break;
	}
	case A1:
	{
		cond = data >> 28;
		code = (data & 0xfff00) >> 4 | (data & 0xf);
		break;
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		execute_psv_func_by_index(CPU, code);
	}
}

void ARMv7Interpreter::ADC_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ADC_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ADC_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::ADD_IMM(const u32 data, const ARMv7_encoding type)
{
	bool set_flags = !CPU.ITSTATE;
	u32 cond = CPU.ITSTATE.advance();
	u32 d = 0;
	u32 n = 0;
	u32 imm32 = 0;

	switch (type)
	{
	case T1:
	{
		d = (data & 0x7);
		n = (data & 0x38) >> 3;
		imm32 = (data & 0x1c0) >> 6;
		break;
	}
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		if (set_flags)
		{
			bool carry, overflow;
			u32 res = AddWithCarry(CPU.read_gpr(n), imm32, false, carry, overflow);
			CPU.write_gpr(d, res);
			CPU.APSR.N = res >> 31;
			CPU.APSR.Z = res == 0;
			CPU.APSR.C = carry;
			CPU.APSR.V = overflow;
		}
		else
		{
			CPU.write_gpr(d, CPU.read_gpr(n) + imm32);
		}
	}
}

void ARMv7Interpreter::ADD_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ADD_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ADD_SPI(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ADD_SPR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::ADR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::AND_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::AND_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::AND_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::ASR_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ASR_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::B(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 jump = 0; // jump = instr_size + imm32 ???

	switch (type)
	{
	case T1:
	{
		cond = (data >> 8) & 0xf;
		if (cond == 0xf)
		{
			throw "SVC";
		}

		jump = 4 + sign<9, u32>((data & 0xff) << 1);
		break;
	}
	case T2:
	{
		jump = 4 + sign<12, u32>((data & 0x7ff) << 1);
		break;
	}
	case T3:
	{
		cond = (data >> 6) & 0xf;
		if (cond >= 0xe)
		{
			throw "B_T3: Related encodings";
		}

		u32 s = (data >> 26) & 0x1;
		u32 j1 = (data >> 13) & 0x1;
		u32 j2 = (data >> 11) & 0x1;
		jump = 4 + sign<21, u32>(s << 20 | j2 << 19 | j1 << 18 | (data & 0x3f0000) >> 4 | (data & 0x7ff) << 1);
		break;
	}
	case T4:
	{
		u32 s = (data >> 26) & 0x1;
		u32 i1 = (data >> 13) & 0x1 ^ s ^ 1;
		u32 i2 = (data >> 11) & 0x1 ^ s ^ 1;
		jump = 4 + sign<25, u32>(s << 24 | i2 << 23 | i1 << 22 | (data & 0x3ff0000) >> 4 | (data & 0x7ff) << 1);
		break;
	}
	case A1:
	{
		cond = data >> 28;
		jump = 1 + 4 + sign<26, u32>((data & 0xffffff) << 2);
		break;
	}
	}

	if (ConditionPassed(cond))
	{
		CPU.SetBranch(CPU.PC + jump);
	}
}


void ARMv7Interpreter::BFC(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::BFI(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::BIC_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::BIC_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::BIC_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::BKPT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::BL(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 newLR = CPU.PC;
	u32 imm32 = 0;

	switch (type)
	{
	case T1:
	{
		u32 s = (data >> 26) & 0x1;
		u32 i1 = (data >> 13) & 0x1 ^ s ^ 1;
		u32 i2 = (data >> 11) & 0x1 ^ s ^ 1;
		imm32 = 4 + sign<25, u32>(s << 24 | i2 << 23 | i1 << 22 | (data & 0x3ff0000) >> 4 | (data & 0x7ff) << 1);
		newLR = (CPU.PC + 4) | 1;
		break;
	}
	case A1:
	{
		cond = data >> 28;
		imm32 = 4 + sign<26, u32>((data & 0xffffff) << 2);
		newLR = (CPU.PC + 4) - 4;
		break;
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		CPU.LR = newLR;
		CPU.SetBranch(CPU.PC + imm32);
	}
}

void ARMv7Interpreter::BLX(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 newLR = CPU.PC;
	u32 target = 0;

	switch (type)
	{
	case T1:
	{
		target = CPU.read_gpr((data >> 3) & 0xf);
		newLR = (CPU.PC + 2) | 1; // ???
		break;
	}
	case T2:
	{
		u32 s = (data >> 26) & 0x1;
		u32 i1 = (data >> 13) & 0x1 ^ s ^ 1;
		u32 i2 = (data >> 11) & 0x1 ^ s ^ 1;
		target = (CPU.PC + 4 & ~3) + sign<25, u32>(s << 24 | i2 << 23 | i1 << 22 | (data & 0x3ff0000) >> 4 | (data & 0x7ff) << 1);
		newLR = (CPU.PC + 4) | 1;
		break;
	}
	case A1:
	{
		cond = data >> 28;
		target = CPU.read_gpr(data & 0xf);
		newLR = (CPU.PC + 4) - 4;
		break;
	}
	case A2:
	{
		target = (CPU.PC + 4 | 1) + sign<25, u32>((data & 0xffffff) << 2 | (data & 0x1000000) >> 23);
		newLR = (CPU.PC + 4) - 4;
		break;
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		CPU.LR = newLR;
		if (target & 1)
		{
			CPU.ISET = Thumb;
			CPU.SetBranch(target & ~1);
		}
		else
		{
			CPU.ISET = ARM;
			CPU.SetBranch(target);
		}
	}
}

void ARMv7Interpreter::BX(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 target = 0;

	switch (type)
	{
	case T1:
	{
		target = CPU.read_gpr((data >> 3) & 0xf);
		break;
	}
	case A1:
	{
		cond = data >> 28;
		target = CPU.read_gpr(data & 0xf);
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		if (target & 1)
		{
			CPU.ISET = Thumb;
			CPU.SetBranch(target & ~1);
		}
		else
		{
			CPU.ISET = ARM;
			CPU.SetBranch(target);
		}
	}
}


void ARMv7Interpreter::CB_Z(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case T1: break;
	default: throw __FUNCTION__;
	}

	if ((CPU.read_gpr(data & 0x7) == 0) ^ ((data & 0x800) != 0))
	{
		CPU.SetBranch(CPU.PC + 2 + ((data & 0xf8) >> 2) + ((data & 0x200) >> 3));
	}
}


void ARMv7Interpreter::CLZ(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::CMN_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::CMN_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::CMN_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::CMP_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::CMP_REG(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 n = 0;
	u32 m = 0;
	auto shift_t = SRType_LSL;
	u32 shift_n = 0;

	switch (type)
	{
	case T1:
	{
		n = (data & 0x7);
		m = (data & 0x38) >> 3;
		break;
	}
	case T2:
	{
		n = (data & 0x80) >> 4 | (data & 0x7);
		m = (data & 0x78) >> 3;
		break;
	}
	case T3:
	{
		n = (data & 0xf0000) >> 16;
		m = (data & 0xf);
		shift_t = DecodeImmShift((data & 0x30) >> 4, (data & 0x7000) >> 10 | (data & 0xc0) >> 6, &shift_n);
		break;
	}
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		bool carry, overflow;
		const u32 shifted = Shift(CPU.read_gpr(m), shift_t, shift_n, true);
		const u32 res = AddWithCarry(CPU.read_gpr(n), ~shifted, true, carry, overflow);
		CPU.APSR.N = res >> 31;
		CPU.APSR.Z = res == 0;
		CPU.APSR.C = carry;
		CPU.APSR.V = overflow;
	}
}

void ARMv7Interpreter::CMP_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::EOR_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::EOR_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::EOR_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::IT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case T1:
	{
		if ((data & 0xf) == 0)
		{
			throw "IT_T1: Related encodings";
		}

		CPU.ITSTATE.IT = data & 0xff;
		return;
	}
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::LDM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDMDA(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDMDB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDMIB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::LDR_IMM(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 t = 0;
	u32 n = 13;
	u32 imm32 = 0;
	bool index = true;
	bool add = true;
	bool wback = false;

	switch (type)
	{
	case T1:
	{
		t = (data & 0x7);
		n = (data & 0x38) >> 3;
		imm32 = (data & 0x7c0) >> 4;
		break;
	}
	case T2:
	{
		t = (data & 0x700) >> 8;
		imm32 = (data & 0xff) << 2;
		break;
	}
	case T3:
	{
		t = (data & 0xf000) >> 12;
		n = (data & 0xf0000) >> 16;
		imm32 = (data & 0xfff);

		if (n == 15)
		{
			throw "LDR (literal)";
		}
		break;
	}
	case T4:
	{
		t = (data & 0xf000) >> 12;
		n = (data & 0xf0000) >> 16;
		imm32 = (data & 0xff);
		index = (data & 0x400);
		add = (data & 0x200);
		wback = (data & 0x100);

		if (n == 15)
		{
			throw "LDR (literal)";
		}
		if (index && add && !wback)
		{
			throw "LDRT";
		}
		if (n == 13 && !index && add && wback && imm32 == 4)
		{
			throw "POP";
		}
		if (!index && !wback)
		{
			throw "LDR_IMM_T4: undefined";
		}
		break;
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		const u32 offset_addr = add ? CPU.read_gpr(n) + imm32 : CPU.read_gpr(n) - imm32;
		const u32 addr = index ? offset_addr : CPU.read_gpr(n);

		if (wback)
		{
			CPU.write_gpr(n, offset_addr);
		}

		CPU.write_gpr(t, vm::psv::read32(addr));
	}
}

void ARMv7Interpreter::LDR_LIT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDR_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::LDRB_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRB_LIT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRB_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::LDRD_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRD_LIT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRD_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::LDRH_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRH_LIT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRH_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::LDRSB_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRSB_LIT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRSB_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::LDRSH_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRSH_LIT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LDRSH_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::LSL_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LSL_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::LSR_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::LSR_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::MLA(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::MLS(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::MOV_IMM(const u32 data, const ARMv7_encoding type)
{
	bool set_flags = !CPU.ITSTATE;
	bool carry = CPU.APSR.C;
	u32 cond = CPU.ITSTATE.advance();
	u32 d = 0;
	u32 imm32 = 0;

	switch (type)
	{
	case T1:
	{
		d = (data >> 8) & 0x7;
		imm32 = sign<8, u32>(data & 0xff);
		break;
	}
	case T2:
	{
		set_flags = data & 0x100000;
		d = (data >> 8) & 0xf;
		imm32 = ThumbExpandImm_C((data & 0x4000000) >> 15 | (data & 0x7000) >> 4 | (data & 0xff), carry, carry);
		break;
	}
	case T3:
	{
		set_flags = false;
		d = (data >> 8) & 0xf;
		imm32 = (data & 0xf0000) >> 4 | (data & 0x4000000) >> 15 | (data & 0x7000) >> 4 | (data & 0xff);
		break;
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		CPU.write_gpr(d, imm32);
		if (set_flags)
		{
			CPU.APSR.N = imm32 >> 31;
			CPU.APSR.Z = imm32 == 0;
			CPU.APSR.C = carry;
		}
	}
}

void ARMv7Interpreter::MOV_REG(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 d = 0;
	u32 m = 0;
	bool set_flags = false;

	switch (type)
	{
	case T1:
	{
		d = (data & 0x80) >> 4 | (data & 0x7);
		m = (data & 0x78) >> 3;
		break;
	}
	case T2:
	{
		d = (data & 0x7);
		m = (data & 0x38) >> 3;
		set_flags = true;
		break;
	}
	case T3:
	{
		d = (data & 0xf00) >> 8;
		m = (data & 0xf);
		set_flags = (data & 0x100000);
		break;
	}
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		u32 res = CPU.read_gpr(m);
		CPU.write_gpr(d, res);
		if (set_flags)
		{
			CPU.APSR.N = res >> 31;
			CPU.APSR.Z = res == 0;
			//CPU.APSR.C = ?
		}
	}
}

void ARMv7Interpreter::MOVT(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 d = 0;
	u32 imm16 = 0;

	switch (type)
	{
	case T1:
	{
		d = (data & 0xf00) >> 8;
		imm16 = (data & 0xf0000) >> 4 | (data & 0x4000000) >> 14 | (data & 0x7000) >> 4 | (data & 0xff);
		break;
	}
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		CPU.write_gpr(d, (CPU.read_gpr(d) & 0xffff) | (imm16 << 16));
	}
}


void ARMv7Interpreter::MRS(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::MSR_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::MSR_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::MUL(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::MVN_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::MVN_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::MVN_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::NOP(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();

	switch (type)
	{
	case T1:
	{
		break;
	}
	case T2:
	{
		break;
	}
	case A1:
	{
		cond = data >> 28;
		break;
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
	}
}


void ARMv7Interpreter::ORN_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ORN_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::ORR_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ORR_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ORR_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::PKH(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::POP(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u16 reg_list = 0;

	switch (type)
	{
	case T1:
	{
		reg_list = ((data & 0x100) << 7) | (data & 0xff);
		break;
	}
	case T2:
	{
		reg_list = data & 0xdfff;
		break;
	}
	case T3:
	{
		reg_list = 1 << (data >> 12);
		break;
	}
	case A1:
	{
		cond = data >> 28;
		reg_list = data & 0xffff;
		if (BitCount(reg_list) < 2)
		{
			throw "LDM / LDMIA / LDMFD";
		}
		break;
	}
	case A2:
	{
		cond = data >> 28;
		reg_list = 1 << ((data >> 12) & 0xf);
		break;
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		for (u16 mask = 1, i = 0; mask; mask <<= 1, i++)
		{
			if (reg_list & mask)
			{
				CPU.write_gpr(i, vm::psv::read32(CPU.SP));
				CPU.SP += 4;
			}
		}
	}
}

void ARMv7Interpreter::PUSH(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u16 reg_list = 0;

	switch (type)
	{
	case T1:
	{
		reg_list = ((data & 0x100) << 6) | (data & 0xff);
		break;
	}
	case T2:
	{
		reg_list = data & 0x5fff;
		break;
	}
	case T3:
	{
		reg_list = 1 << (data >> 12);
		break;
	}
	case A1:
	{
		cond = data >> 28;
		reg_list = data & 0xffff;
		if (BitCount(reg_list) < 2)
		{
			throw "STMDB / STMFD";
		}
		break;
	}
	case A2:
	{
		cond = data >> 28;
		reg_list = 1 << ((data >> 12) & 0xf);
		break;
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		for (u16 mask = 1 << 15, i = 15; mask; mask >>= 1, i--)
		{
			if (reg_list & mask)
			{
				CPU.SP -= 4;
				vm::psv::write32(CPU.SP, CPU.read_gpr(i));
			}
		}
	}
}


void ARMv7Interpreter::QADD(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::QADD16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::QADD8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::QASX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::QDADD(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::QDSUB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::QSAX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::QSUB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::QSUB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::QSUB8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::RBIT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::REV(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::REV16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::REVSH(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::ROR_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::ROR_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::RRX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::RSB_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::RSB_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::RSB_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::RSC_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::RSC_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::RSC_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SADD16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SADD8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SASX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SBC_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SBC_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SBC_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SBFX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SDIV(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SEL(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SHADD16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SHADD8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SHASX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SHSAX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SHSUB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SHSUB8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SMLA__(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMLAD(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMLAL(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMLAL__(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMLALD(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMLAW_(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMLSD(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMLSLD(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMMLA(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMMLS(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMMUL(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMUAD(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMUL__(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMULL(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMULW_(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SMUSD(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SSAT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SSAT16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SSAX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SSUB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SSUB8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::STM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::STMDA(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::STMDB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::STMIB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::STR_IMM(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 t = 16;
	u32 n = 13;
	u32 imm32 = 0;
	bool index = true;
	bool add = true;
	bool wback = false;

	switch (type)
	{
	case T1:
	{
		t = (data & 0x7);
		n = (data & 0x38) >> 3;
		imm32 = (data & 0x7c0) >> 4;
		break;
	}
	case T2:
	{
		t = (data & 0x700) >> 8;
		imm32 = (data & 0xff) << 2;
		break;
	}
	case T3:
	{
		t = (data & 0xf000) >> 12;
		n = (data & 0xf0000) >> 16;
		imm32 = (data & 0xfff);

		if (n == 0xf)
		{
			throw "STR_IMM_T3: undefined";
		}
		break;
	}
	case T4:
	{
		t = (data & 0xf000) >> 12;
		n = (data & 0xf0000) >> 16;
		imm32 = (data & 0xff);
		index = (data & 0x400);
		add = (data & 0x200);
		wback = (data & 0x100);

		if (index && add && !wback)
		{
			throw "STRT";
		}
		if (n == 13 && index && !add && wback && imm32 == 4)
		{
			throw "PUSH";
		}
		if (n == 15 || (!index && !wback))
		{
			throw "STR_IMM_T4: undefined";
		}
		break;
	}
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		const u32 offset_addr = add ? CPU.read_gpr(n) + imm32 : CPU.read_gpr(n) - imm32;
		const u32 addr = index ? offset_addr : CPU.read_gpr(n);

		vm::psv::write32(addr, CPU.read_gpr(t));

		if (wback)
		{
			CPU.write_gpr(n, offset_addr);
		}
	}
}

void ARMv7Interpreter::STR_REG(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 t = 0;
	u32 n = 0;
	u32 m = 0;
	bool index = true;
	bool add = true;
	bool wback = false;
	auto shift_t = SRType_LSL;
	u32 shift_n = 0;

	switch (type)
	{
	case T1:
	{
		t = (data & 0x7);
		n = (data & 0x38) >> 3;
		m = (data & 0x1c0) >> 6;
		break;
	}
	case T2:
	{
		t = (data & 0xf000) >> 12;
		n = (data & 0xf0000) >> 16;
		m = (data & 0xf);
		shift_n = (data & 0x30) >> 4;

		if (n == 15)
		{
			throw "STR_REG_T2: undefined";
		}
		break;
	}
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		const u32 offset = Shift(CPU.read_gpr(m), shift_t, shift_n, CPU.APSR.C);
		const u32 offset_addr = add ? CPU.read_gpr(n) + offset : CPU.read_gpr(n) - offset;
		const u32 addr = index ? offset_addr : CPU.read_gpr(n);

		vm::psv::write32(addr, CPU.read_gpr(t));

		if (wback)
		{
			CPU.write_gpr(n, offset_addr);
		}
	}
}


void ARMv7Interpreter::STRB_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::STRB_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::STRD_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::STRD_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::STRH_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::STRH_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SUB_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SUB_REG(const u32 data, const ARMv7_encoding type)
{
	bool set_flags = !CPU.ITSTATE;
	u32 cond = CPU.ITSTATE.advance();
	u32 d = 0;
	u32 n = 0;
	u32 m = 0;
	auto shift_t = SRType_LSL;
	u32 shift_n = 0;

	switch (type)
	{
	case T1:
	{
		d = (data & 0x7);
		n = (data & 0x38) >> 3;
		m = (data & 0x1c0) >> 6;
		break;
	}
	case T2:
	{
		d = (data & 0xf00) >> 8;
		n = (data & 0xf0000) >> 16;
		m = (data & 0xf);
		set_flags = (data & 0x100000);
		shift_t = DecodeImmShift((data & 0x30) >> 4, (data & 0x7000) >> 10 | (data & 0xc0) >> 6, &shift_n);

		if (d == 15 && set_flags)
		{
			throw "CMP (register)";
		}
		if (n == 13)
		{
			throw "SUB (SP minus register)";
		}
		break;
	}
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		u32 shifted = Shift(CPU.read_gpr(m), shift_t, shift_n, CPU.APSR.C);
		if (set_flags)
		{
			bool carry, overflow;
			u32 res = AddWithCarry(CPU.read_gpr(n), ~shifted, true, carry, overflow);
			CPU.write_gpr(d, res);
			CPU.APSR.N = res >> 31;
			CPU.APSR.Z = res == 0;
			CPU.APSR.C = carry;
			CPU.APSR.V = overflow;
		}
		else
		{
			CPU.write_gpr(d, CPU.read_gpr(n) - shifted);
		}
	}
}

void ARMv7Interpreter::SUB_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SUB_SPI(const u32 data, const ARMv7_encoding type)
{
	u32 cond = CPU.ITSTATE.advance();
	u32 d = 13;
	u32 imm32 = 0;
	bool set_flags = false;

	switch (type)
	{
	case T1:
	{
		imm32 = (data & 0x7f) << 2;
		break;
	}
	default: throw __FUNCTION__;
	}

	if (ConditionPassed(cond))
	{
		if (set_flags)
		{
			bool carry, overflow;
			u32 res = AddWithCarry(CPU.SP, ~imm32, true, carry, overflow);
			CPU.write_gpr(d, res);
			CPU.APSR.N = res >> 31;
			CPU.APSR.Z = res == 0;
			CPU.APSR.C = carry;
			CPU.APSR.V = overflow;
		}
		else
		{
			CPU.write_gpr(d, CPU.SP - imm32);
		}
	}
}

void ARMv7Interpreter::SUB_SPR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SVC(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::SXTAB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SXTAB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SXTAH(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SXTB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SXTB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::SXTH(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::TB_(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::TEQ_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::TEQ_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::TEQ_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::TST_IMM(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::TST_REG(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::TST_RSR(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}


void ARMv7Interpreter::UADD16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UADD8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UASX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UBFX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UDIV(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UHADD16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UHADD8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UHASX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UHSAX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UHSUB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UHSUB8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UMAAL(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UMLAL(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UMULL(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UQADD16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UQADD8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UQASX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UQSAX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UQSUB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UQSUB8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::USAD8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::USADA8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::USAT(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::USAT16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::USAX(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::USUB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::USUB8(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UXTAB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UXTAB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UXTAH(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UXTB(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UXTB16(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}

void ARMv7Interpreter::UXTH(const u32 data, const ARMv7_encoding type)
{
	switch (type)
	{
	case A1: throw __FUNCTION__;
	default: throw __FUNCTION__;
	}
}