libretro/Play-
1
0
Fork 0
mirror of https://github.com/libretro/Play-.git synced 2024-12-04 23:36:30 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity
568d187f87
Play-/Source/COP_FPU.cpp
jpd002 568d187f87 MacOS 
git-svn-id: http://svn.purei.org/purei/trunk@185 b36208d7-6611-0410-8bec-b1987f11c4a2
2007-12-07 00:26:56 +00:00

547 lines
11 KiB
C++
Raw Blame History

#include <string.h>
#include <stdio.h>
#include "COP_FPU.h"
#include "MIPS.h"
#include "CodeGen_FPU.h"
using namespace CodeGen;
CCOP_FPU g_COPFPU(MIPS_REGSIZE_64);
uint8 CCOP_FPU::m_nFT;
uint8 CCOP_FPU::m_nFS;
uint8 CCOP_FPU::m_nFD;
uint32 CCOP_FPU::m_nCCMask[8] =
{
0x00800000,
0x02000000,
0x04000000,
0x08000000,
0x10000000,
0x20000000,
0x40000000,
0x80000000
};
CCOP_FPU::CCOP_FPU(MIPS_REGSIZE nRegSize) :
CMIPSCoprocessor(nRegSize)
{
SetupReflectionTables();
}
void CCOP_FPU::CompileInstruction(uint32 nAddress, CCacheBlock* pBlock, CMIPS* pCtx, bool nParent)
{
if(nParent)
{
SetupQuickVariables(nAddress, pBlock, pCtx);
}
m_nFT = (uint8)((m_nOpcode >> 16) & 0x1F);
m_nFS = (uint8)((m_nOpcode >> 11) & 0x1F);
m_nFD = (uint8)((m_nOpcode >> 6) & 0x1F);
switch((m_nOpcode >> 26) & 0x3F)
{
case 0x11:
//COP1
m_pOpGeneral[(m_nOpcode >> 21) & 0x1F]();
break;
case 0x31:
LWC1();
break;
case 0x39:
SWC1();
break;
default:
Illegal();
break;
}
}
void CCOP_FPU::SetCCBit(bool nCondition, uint32 nMask)
{
CCodeGen::BeginIfElse(nCondition);
{
CCodeGen::PushVar(&m_pCtx->m_State.nFCSR);
CCodeGen::PushCst(nMask);
CCodeGen::Or();
CCodeGen::PullVar(&m_pCtx->m_State.nFCSR);
}
CCodeGen::BeginIfElseAlt();
{
CCodeGen::PushVar(&m_pCtx->m_State.nFCSR);
CCodeGen::PushCst(~nMask);
CCodeGen::And();
CCodeGen::PullVar(&m_pCtx->m_State.nFCSR);
}
CCodeGen::EndIf();
}
void CCOP_FPU::TestCCBit(uint32 nMask)
{
m_pB->PushAddr(&m_pCtx->m_State.nFCSR);
m_pB->AndImm(nMask);
m_pB->PushImm(0);
m_pB->Cmp(JCC_CONDITION_NE);
}
//////////////////////////////////////////////////
//General Opcodes
//////////////////////////////////////////////////
//00
void CCOP_FPU::MFC1()
{
CCodeGen::Begin(m_pB);
{
m_pB->PushAddr(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
SignExtendTop32(m_nFT);
m_pB->PullAddr(&m_pCtx->m_State.nGPR[m_nFT].nV[0]);
}
CCodeGen::End();
}
//04
void CCOP_FPU::MTC1()
{
CCodeGen::Begin(m_pB);
{
m_pB->PushAddr(&m_pCtx->m_State.nGPR[m_nFT].nV[0]);
m_pB->PullAddr(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
}
CCodeGen::End();
}
//06
void CCOP_FPU::CTC1()
{
CCodeGen::Begin(m_pB);
{
if(m_nFS == 31)
{
m_pB->PushAddr(&m_pCtx->m_State.nGPR[m_nFT].nV[0]);
m_pB->PullAddr(&m_pCtx->m_State.nFCSR);
}
}
CCodeGen::End();
}
//08
void CCOP_FPU::BC1()
{
switch((m_nOpcode >> 16) & 0x03)
{
case 0x00:
BC1F();
break;
case 0x01:
BC1T();
break;
case 0x02:
BC1FL();
break;
case 0x03:
BC1TL();
break;
default:
Illegal();
break;
}
}
//10
void CCOP_FPU::S()
{
m_pOpSingle[(m_nOpcode & 0x3F)]();
}
//14
void CCOP_FPU::W()
{
m_pOpWord[(m_nOpcode & 0x3F)]();
}
//////////////////////////////////////////////////
//Branch Opcodes
//////////////////////////////////////////////////
//00
void CCOP_FPU::BC1F()
{
CCodeGen::Begin(m_pB);
{
TestCCBit(m_nCCMask[(m_nOpcode >> 18) & 0x07]);
Branch(false);
}
CCodeGen::End();
}
//01
void CCOP_FPU::BC1T()
{
CCodeGen::Begin(m_pB);
{
TestCCBit(m_nCCMask[(m_nOpcode >> 18) & 0x07]);
Branch(true);
}
CCodeGen::End();
}
//02
void CCOP_FPU::BC1FL()
{
CCodeGen::Begin(m_pB);
{
TestCCBit(m_nCCMask[(m_nOpcode >> 18) & 0x07]);
BranchLikely(false);
}
CCodeGen::End();
}
//03
void CCOP_FPU::BC1TL()
{
CCodeGen::Begin(m_pB);
{
TestCCBit(m_nCCMask[(m_nOpcode >> 18) & 0x07]);
BranchLikely(true);
}
CCodeGen::End();
}
//////////////////////////////////////////////////
//Single Precision Floating Point Opcodes
//////////////////////////////////////////////////
//00
void CCOP_FPU::ADD_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::Add();
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//01
void CCOP_FPU::SUB_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::Sub();
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//02
void CCOP_FPU::MUL_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::Mul();
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//03
void CCOP_FPU::DIV_S()
{
CCodeGen::Begin(m_pB);
{
//Check if FT equals to 0
CCodeGen::PushVar(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CCodeGen::PushCst(0);
CCodeGen::Cmp(CCodeGen::CONDITION_EQ);
CCodeGen::BeginIfElse(true);
{
CCodeGen::PushCst(0x7F7FFFFF);
CCodeGen::PullVar(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::BeginIfElseAlt();
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::Div();
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::EndIf();
}
CCodeGen::End();
}
//04
void CCOP_FPU::SQRT_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::Sqrt();
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//05
void CCOP_FPU::ABS_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::Abs();
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//06
void CCOP_FPU::MOV_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//07
void CCOP_FPU::NEG_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::Neg();
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//18
void CCOP_FPU::ADDA_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::Add();
CFPU::PullSingle(&m_pCtx->m_State.nCOP1A);
}
CCodeGen::End();
}
//1A
void CCOP_FPU::MULA_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::Mul();
CFPU::PullSingle(&m_pCtx->m_State.nCOP1A);
}
CCodeGen::End();
}
//1C
void CCOP_FPU::MADD_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP1A);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::Mul();
CFPU::Add();
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//1D
void CCOP_FPU::MSUB_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP1A);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::Mul();
CFPU::Sub();
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//24
void CCOP_FPU::CVT_W_S()
{
CCodeGen::Begin(m_pB);
{
//Load the rounding mode from FCSR?
CFPU::PushRoundingMode();
CFPU::SetRoundingMode(CFPU::ROUND_TRUNCATE);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PullWord(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
CFPU::PullRoundingMode();
}
CCodeGen::End();
}
//32
void CCOP_FPU::C_EQ_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::Cmp(CCodeGen::CONDITION_EQ);
SetCCBit(true, m_nCCMask[((m_nOpcode >> 8) & 0x07)]);
}
CCodeGen::End();
}
//34
void CCOP_FPU::C_LT_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::Cmp(CCodeGen::CONDITION_BL);
SetCCBit(true, m_nCCMask[((m_nOpcode >> 8) & 0x07)]);
}
CCodeGen::End();
}
//36
void CCOP_FPU::C_LE_S()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
CFPU::PushSingle(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::Cmp(CCodeGen::CONDITION_BE);
SetCCBit(true, m_nCCMask[((m_nOpcode >> 8) & 0x07)]);
}
CCodeGen::End();
}
//////////////////////////////////////////////////
//Word Sized Integer Opcodes
//////////////////////////////////////////////////
//20
void CCOP_FPU::CVT_S_W()
{
CCodeGen::Begin(m_pB);
{
CFPU::PushWord(&m_pCtx->m_State.nCOP10[m_nFS * 2]);
CFPU::PullSingle(&m_pCtx->m_State.nCOP10[m_nFD * 2]);
}
CCodeGen::End();
}
//////////////////////////////////////////////////
//Miscellanous Opcodes
//////////////////////////////////////////////////
//31
void CCOP_FPU::LWC1()
{
CCodeGen::Begin(m_pB);
{
ComputeMemAccessAddr();
//Load the word
m_pB->PushRef(m_pCtx);
// m_pB->Call(&CCacheBlock::GetWordProxy, 2, true);
m_pB->PullAddr(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
}
CCodeGen::End();
}
//39
void CCOP_FPU::SWC1()
{
CCodeGen::Begin(m_pB);
{
ComputeMemAccessAddr();
//Write the words
m_pB->PushAddr(&m_pCtx->m_State.nCOP10[m_nFT * 2]);
m_pB->PushRef(m_pCtx);
// m_pB->Call(&CCacheBlock::SetWordProxy, 3, false);
}
CCodeGen::End();
}
//////////////////////////////////////////////////
//Opcode Tables
//////////////////////////////////////////////////
void (*CCOP_FPU::m_pOpGeneral[0x20])() =
{
//0x00
MFC1, Illegal, Illegal, Illegal, MTC1, Illegal, CTC1, Illegal,
//0x08
BC1, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x10
S, Illegal, Illegal, Illegal, W, Illegal, Illegal, Illegal,
//0x18
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
};
void (*CCOP_FPU::m_pOpSingle[0x40])() =
{
//0x00
ADD_S, SUB_S, MUL_S, DIV_S, SQRT_S, ABS_S, MOV_S, NEG_S,
//0x08
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x10
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x18
ADDA_S, Illegal, MULA_S, Illegal, MADD_S, MSUB_S, Illegal, Illegal,
//0x20
Illegal, Illegal, Illegal, Illegal, CVT_W_S, Illegal, Illegal, Illegal,
//0x28
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x30
Illegal, Illegal, C_EQ_S, Illegal, C_LT_S, Illegal, C_LE_S, Illegal,
//0x38
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
};
void (*CCOP_FPU::m_pOpWord[0x40])() =
{
//0x00
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x08
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x10
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x18
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x20
CVT_S_W, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x28
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x30
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
//0x38
Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal, Illegal,
};
Reference in New Issue View Git Blame Copy Permalink