// Copyright 2010 Dolphin Emulator Project
// Licensed under GPLv2+
// Refer to the license.txt file included.

// Additional copyrights go to Duddie and Tratax (c) 2004

#include "Core/DSP/DSPEmitter.h"
#include "Core/DSP/DSPIntCCUtil.h"
#include "Core/DSP/DSPInterpreter.h"
#include "Core/DSP/DSPIntUtil.h"
#include "Core/DSP/DSPMemoryMap.h"

using namespace Gen;

// SRS @M, $(0x18+S)
// 0010 1sss mmmm mmmm
// Move value from register $(0x18+D) to data memory pointed by address
// CR[0-7] | M. That is, the upper 8 bits of the address are the
// bottom 8 bits from CR, and the lower 8 bits are from the 8-bit immediate.
// Note: pc+=2 in duddie's doc seems wrong
void DSPEmitter::srs(const UDSPInstruction opc)
{
	u8 reg   = ((opc >> 8) & 0x7) + 0x18;
	//u16 addr = (g_dsp.r.cr << 8) | (opc & 0xFF);

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(reg, tmp1, ZERO);
	dsp_op_read_reg(DSP_REG_CR, RAX, ZERO);
	SHL(16, R(EAX), Imm8(8));
	OR(16, R(EAX), Imm16(opc & 0xFF));
	dmem_write(tmp1);

	gpr.putXReg(tmp1);
}

// LRS $(0x18+D), @M
// 0010 0ddd mmmm mmmm
// Move value from data memory pointed by address CR[0-7] | M to register
// $(0x18+D).  That is, the upper 8 bits of the address are the bottom 8 bits
// from CR, and the lower 8 bits are from the 8-bit immediate.
void DSPEmitter::lrs(const UDSPInstruction opc)
{
	u8 reg   = ((opc >> 8) & 0x7) + 0x18;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	//u16 addr = (g_dsp.r[DSP_REG_CR] << 8) | (opc & 0xFF);
	dsp_op_read_reg(DSP_REG_CR, tmp1, ZERO);
	SHL(16, R(tmp1), Imm8(8));
	OR(16, R(tmp1), Imm16(opc & 0xFF));
	dmem_read(tmp1);

	gpr.putXReg(tmp1);

	dsp_op_write_reg(reg, RAX);
	dsp_conditional_extend_accum(reg);
}

// LR $D, @M
// 0000 0000 110d dddd
// mmmm mmmm mmmm mmmm
// Move value from data memory pointed by address M to register $D.
void DSPEmitter::lr(const UDSPInstruction opc)
{
	int reg = opc & DSP_REG_MASK;
	u16 address = dsp_imem_read(compilePC + 1);
	dmem_read_imm(address);
	dsp_op_write_reg(reg, EAX);
	dsp_conditional_extend_accum(reg);
}

// SR @M, $S
// 0000 0000 111s ssss
// mmmm mmmm mmmm mmmm
// Store value from register $S to a memory pointed by address M.
void DSPEmitter::sr(const UDSPInstruction opc)
{
	u8 reg   = opc & DSP_REG_MASK;
	u16 address = dsp_imem_read(compilePC + 1);

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(reg, tmp1);
	dmem_write_imm(address, tmp1);

	gpr.putXReg(tmp1);
}

// SI @M, #I
// 0001 0110 mmmm mmmm
// iiii iiii iiii iiii
// Store 16-bit immediate value I to a memory location pointed by address
// M (M is 8-bit value sign extended).
void DSPEmitter::si(const UDSPInstruction opc)
{
	u16 address = (s8)opc;
	u16 imm = dsp_imem_read(compilePC + 1);

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	MOV(32, R(tmp1), Imm32((u32)imm));
	dmem_write_imm(address, tmp1);

	gpr.putXReg(tmp1);
}

// LRR $D, @$S
// 0001 1000 0ssd dddd
// Move value from data memory pointed by addressing register $S to register $D.
void DSPEmitter::lrr(const UDSPInstruction opc)
{
	u8 sreg = (opc >> 5) & 0x3;
	u8 dreg = opc & 0x1f;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(sreg, tmp1);
	dmem_read(tmp1);

	gpr.putXReg(tmp1);

	dsp_op_write_reg(dreg, EAX);
	dsp_conditional_extend_accum(dreg);
}

// LRRD $D, @$S
// 0001 1000 1ssd dddd
// Move value from data memory pointed by addressing register $S toregister $D.
// Decrement register $S.
void DSPEmitter::lrrd(const UDSPInstruction opc)
{
	u8 sreg = (opc >> 5) & 0x3;
	u8 dreg = opc & 0x1f;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(sreg, tmp1);
	dmem_read(tmp1);

	gpr.putXReg(tmp1);

	dsp_op_write_reg(dreg, EAX);
	dsp_conditional_extend_accum(dreg);
	decrement_addr_reg(sreg);
}

// LRRI $D, @$S
// 0001 1001 0ssd dddd
// Move value from data memory pointed by addressing register $S to register $D.
// Increment register $S.
void DSPEmitter::lrri(const UDSPInstruction opc)
{
	u8 sreg = (opc >> 5) & 0x3;
	u8 dreg = opc & 0x1f;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(sreg, tmp1);
	dmem_read(tmp1);

	gpr.putXReg(tmp1);

	dsp_op_write_reg(dreg, EAX);
	dsp_conditional_extend_accum(dreg);
	increment_addr_reg(sreg);
}

// LRRN $D, @$S
// 0001 1001 1ssd dddd
// Move value from data memory pointed by addressing register $S to register $D.
// Add indexing register $(0x4+S) to register $S.
void DSPEmitter::lrrn(const UDSPInstruction opc)
{
	u8 sreg = (opc >> 5) & 0x3;
	u8 dreg = opc & 0x1f;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(sreg, tmp1);
	dmem_read(tmp1);

	gpr.putXReg(tmp1);

	dsp_op_write_reg(dreg, EAX);
	dsp_conditional_extend_accum(dreg);
	increase_addr_reg(sreg, sreg);
}

// SRR @$D, $S
// 0001 1010 0dds ssss
// Store value from source register $S to a memory location pointed by
// addressing register $D.
void DSPEmitter::srr(const UDSPInstruction opc)
{
	u8 dreg = (opc >> 5) & 0x3;
	u8 sreg = opc & 0x1f;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(sreg, tmp1);
	dsp_op_read_reg(dreg, RAX, ZERO);
	dmem_write(tmp1);

	gpr.putXReg(tmp1);
}

// SRRD @$D, $S
// 0001 1010 1dds ssss
// Store value from source register $S to a memory location pointed by
// addressing register $D. Decrement register $D.
void DSPEmitter::srrd(const UDSPInstruction opc)
{
	u8 dreg = (opc >> 5) & 0x3;
	u8 sreg = opc & 0x1f;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(sreg, tmp1);
	dsp_op_read_reg(dreg, RAX, ZERO);
	dmem_write(tmp1);

	gpr.putXReg(tmp1);

	decrement_addr_reg(dreg);
}

// SRRI @$D, $S
// 0001 1011 0dds ssss
// Store value from source register $S to a memory location pointed by
// addressing register $D. Increment register $D.
void DSPEmitter::srri(const UDSPInstruction opc)
{
	u8 dreg = (opc >> 5) & 0x3;
	u8 sreg = opc & 0x1f;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(sreg, tmp1);
	dsp_op_read_reg(dreg, RAX, ZERO);
	dmem_write(tmp1);

	gpr.putXReg(tmp1);

	increment_addr_reg(dreg);
}

// SRRN @$D, $S
// 0001 1011 1dds ssss
// Store value from source register $S to a memory location pointed by
// addressing register $D. Add DSP_REG_IX0 register to register $D.
void DSPEmitter::srrn(const UDSPInstruction opc)
{
	u8 dreg = (opc >> 5) & 0x3;
	u8 sreg = opc & 0x1f;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(sreg, tmp1);
	dsp_op_read_reg(dreg, RAX, ZERO);
	dmem_write(tmp1);

	gpr.putXReg(tmp1);

	increase_addr_reg(dreg, dreg);
}

// ILRR $acD.m, @$arS
// 0000 001d 0001 00ss
// Move value from instruction memory pointed by addressing register
// $arS to mid accumulator register $acD.m.
void DSPEmitter::ilrr(const UDSPInstruction opc)
{
	u16 reg  = opc & 0x3;
	u16 dreg = (opc >> 8) & 1;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(reg, tmp1, ZERO);
	imem_read(tmp1);

	gpr.putXReg(tmp1);

	set_acc_m(dreg, R(RAX));
	dsp_conditional_extend_accum(dreg + DSP_REG_ACM0);
}

// ILRRD $acD.m, @$arS
// 0000 001d 0001 01ss
// Move value from instruction memory pointed by addressing register
// $arS to mid accumulator register $acD.m. Decrement addressing register $arS.
void DSPEmitter::ilrrd(const UDSPInstruction opc)
{
	u16 reg  = opc & 0x3;
	u16 dreg = (opc >> 8) & 1;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(reg, tmp1, ZERO);
	imem_read(tmp1);

	gpr.putXReg(tmp1);

	set_acc_m(dreg, R(RAX));
	dsp_conditional_extend_accum(dreg + DSP_REG_ACM0);
	decrement_addr_reg(reg);
}

// ILRRI $acD.m, @$S
// 0000 001d 0001 10ss
// Move value from instruction memory pointed by addressing register
// $arS to mid accumulator register $acD.m. Increment addressing register $arS.
void DSPEmitter::ilrri(const UDSPInstruction opc)
{
	u16 reg  = opc & 0x3;
	u16 dreg = (opc >> 8) & 1;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(reg, tmp1, ZERO);
	imem_read(tmp1);

	gpr.putXReg(tmp1);

	set_acc_m(dreg, R(RAX));
	dsp_conditional_extend_accum(dreg + DSP_REG_ACM0);
	increment_addr_reg(reg);
}

// ILRRN $acD.m, @$arS
// 0000 001d 0001 11ss
// Move value from instruction memory pointed by addressing register
// $arS to mid accumulator register $acD.m. Add corresponding indexing
// register $ixS to addressing register $arS.
void DSPEmitter::ilrrn(const UDSPInstruction opc)
{
	u16 reg  = opc & 0x3;
	u16 dreg = (opc >> 8) & 1;

	X64Reg tmp1;
	gpr.getFreeXReg(tmp1);

	dsp_op_read_reg(reg, tmp1, ZERO);
	imem_read(tmp1);

	gpr.putXReg(tmp1);

	set_acc_m(dreg, R(RAX));
	dsp_conditional_extend_accum(dreg + DSP_REG_ACM0);
	increase_addr_reg(reg, reg);
}

