ppsspp/Core/MIPS/PPC/PpcCompFpu.cpp
Unknown W. Brackets 05ab192c9c Reduce includes in Core/HLE/.
Especially templates.
2014-03-15 11:22:19 -07:00

463 lines
No EOL
9.8 KiB
C++

#include "Common/ChunkFile.h"
#include "Core/Config.h"
#include "Core/Core.h"
#include "Core/CoreTiming.h"
#include "Core/MemMap.h"
#include "Core/MIPS/MIPS.h"
#include "Core/MIPS/MIPSCodeUtils.h"
#include "Core/MIPS/MIPSInt.h"
#include "Core/MIPS/MIPSTables.h"
#include "PpcRegCache.h"
#include "ppcEmitter.h"
#include "PpcJit.h"
#define _RS MIPS_GET_RS(op)
#define _RT MIPS_GET_RT(op)
#define _RD MIPS_GET_RD(op)
#define _FS MIPS_GET_FS(op)
#define _FT MIPS_GET_FT(op)
#define _FD MIPS_GET_FD(op)
#define _SA MIPS_GET_SA(op)
#define _POS ((op>> 6) & 0x1F)
#define _SIZE ((op>>11) & 0x1F)
#define _IMM16 (signed short)(op & 0xFFFF)
#define _IMM26 (op & 0x03FFFFFF)
// All functions should have CONDITIONAL_DISABLE, so we can narrow things down to a file quickly.
// Currently known non working ones should have DISABLE.
//#define CONDITIONAL_DISABLE { Comp_Generic(op); return; }
#define CONDITIONAL_DISABLE ;
#define DISABLE { Comp_Generic(op); return; }
using namespace PpcGen;
namespace MIPSComp
{
void Jit::Comp_FPU3op(MIPSOpcode op) {
CONDITIONAL_DISABLE;
int ft = _FT;
int fs = _FS;
int fd = _FD;
fpr.MapDirtyInIn(fd, fs, ft);
switch (op & 0x3f)
{
case 0: FADDS(fpr.R(fd), fpr.R(fs), fpr.R(ft)); break; //F(fd) = F(fs) + F(ft); //add
case 1: FSUBS(fpr.R(fd), fpr.R(fs), fpr.R(ft)); break; //F(fd) = F(fs) - F(ft); //sub
case 2: { //F(fd) = F(fs) * F(ft); //mul
FMULS(fpr.R(fd), fpr.R(fs), fpr.R(ft));
break;
}
case 3: FDIVS(fpr.R(fd), fpr.R(fs), fpr.R(ft)); break; //F(fd) = F(fs) / F(ft); //div
default:
DISABLE;
return;
}
}
void Jit::Comp_FPULS(MIPSOpcode op) {
CONDITIONAL_DISABLE;
s32 offset = (s16)(op & 0xFFFF);
int ft = _FT;
int rs = _RS;
// u32 addr = R(rs) + offset;
// logBlocks = 1;
bool doCheck = false;
if (!g_Config.bFastMemory) {
DISABLE;
}
switch(op >> 26)
{
case 49: //FI(ft) = Memory::Read_U32(addr); break; //lwc1
fpr.SpillLock(ft);
fpr.MapReg(ft, MAP_NOINIT | MAP_DIRTY);
if (gpr.IsImm(rs)) {
u32 addr = (offset + gpr.GetImm(rs)) & 0x3FFFFFFF;
MOVI2R(SREG, addr);
} else {
gpr.MapReg(rs);
SetRegToEffectiveAddress(SREG, rs, offset);
}
LoadFloatSwap(fpr.R(ft), BASEREG, SREG);
fpr.ReleaseSpillLocksAndDiscardTemps();
break;
case 57: //Memory::Write_U32(FI(ft), addr); break; //swc1
fpr.MapReg(ft);
if (gpr.IsImm(rs)) {
u32 addr = (offset + gpr.GetImm(rs)) & 0x3FFFFFFF;
MOVI2R(SREG, addr);
} else {
gpr.MapReg(rs);
SetRegToEffectiveAddress(SREG, rs, offset);
}
SaveFloatSwap(fpr.R(ft), BASEREG, SREG);
break;
default:
Comp_Generic(op);
return;
}
}
#if 0
/**
This can be made with branch, but i'm trying to do it branch free, not working correctly yet ...
**/
void Jit::Comp_FPUComp(MIPSOpcode op) {
DISABLE;
CONDITIONAL_DISABLE;
int opc = op & 0xF;
if (opc >= 8) opc -= 8; // alias
if (opc == 0) { // f, sf (signalling false)
MOVI2R(SREG, 0);
STW(SREG, CTXREG, offsetof(MIPSState, fpcond));
return;
}
int fs = _FS;
int ft = _FT;
fpr.MapInIn(fs, ft);
PPCReg _tmp = FPR8;
PPCReg _zero = FPR6;
PPCReg _one = FPR7;
//VCMP(fpr.R(fs), fpr.R(ft));
//VMRS_APSR(); // Move FP flags from FPSCR to APSR (regular flags).
/**
Condition-Register Field and Floating-Point Condition Code Interpretation
Bit Name Description
1000 FL (FRA) < (FRB)
0100 FG (FRA) > (FRB)
0010 FE (FRA) = (FRB)
0001 FU (FRA) ? (FRB) (unordered)
**/
switch(opc)
{
// OK
case 1: // un, ngle (unordered)
FCMPU(0, fpr.R(fs), fpr.R(ft));
MFCR(SREG);
SRAWI(SREG, SREG, 28);
ANDI(SREG, SREG, 0x1);
break;
// FAIL
case 2: //eq, seq (equal, ordered)
DISABLE;
//Break();
FCMPO(0, fpr.R(fs), fpr.R(ft));
MFCR(SREG);
SRAWI(SREG, SREG, 28);
SRAWI(SREG, SREG, 2);
ANDI(SREG, SREG, 0x1);
break;
// FAIL
case 3: // ueq, ngl (equal, unordered)
DISABLE;
//Break();
FCMPU(0, fpr.R(fs), fpr.R(ft));
MFCR(R7);
SRAWI(R7, R7, 28);
SRAWI(SREG, R7, 2);
ANDI(SREG, SREG, 0x1);
// check unordered
ANDI(R7, R7, 0x1);
// SREG = ((R7 >> 2) & 1) || ((R8 >> 3) & 1)
OR(SREG, R7, SREG);
return;
// OK
case 4: // olt, lt (less than, ordered)
//DISABLE;
//Break();
FCMPO(0, fpr.R(fs), fpr.R(ft));
MFCR(SREG);
SRAWI(SREG, SREG, 28);
SRAWI(SREG, SREG, 3);
// SREG = SREG & 1
ANDI(SREG, SREG, 0x1);
break;
// OK
case 5: // ult, nge (less than, unordered)
//DISABLE;
//Break();
FCMPO(0, fpr.R(fs), fpr.R(ft));
MFCR(R7);
SRAWI(R7, R7, 28);
// SREG = SREG & 1
SRAWI(SREG, R7, 3);
ANDI(SREG, SREG, 0x1);
// check unordered
ANDI(R7, R7, 0x1);
// final
OR(SREG, R7, SREG);
break;
// FAIL
case 6: // ole, le (less equal, ordered)
DISABLE;
//Break();
FCMPO(0, fpr.R(ft), fpr.R(fs));
MFCR(SREG);
SRAWI(SREG, SREG, 28);
// SREG = (SREG >> 1) & 1
SRAWI(SREG, SREG, 3);
ANDI(SREG, SREG, 0x1);
break;
// FAIL
case 7: // ule, ngt (less equal, unordered)
DISABLE;
//Break();
FCMPO(0, fpr.R(ft), fpr.R(fs));
MFCR(R7);
SRAWI(R7, R7, 28);
// SREG = (SREG >> 1) & 1
SRAWI(SREG, R7, 1);
ANDI(SREG, SREG, 0x1);
// check unordered
// R8 = (R7 >> 3) & 1
SRAWI(R8, R7, 3);
ANDI(R8, R8, 0x1);
// SREG = (R7 & 1) || ((R8 >> 3) & 1)
OR(SREG, R7, R8);
break;
default:
Comp_Generic(op);
return;
}
STW(SREG, CTXREG, offsetof(MIPSState, fpcond));
}
#else
/**
* 2nd attempt
**/
void Jit::FPUComp(int fs, int ft, PpcGen::FixupBranchType cond, bool unorderer, int bf) {
PpcGen::FixupBranch ptr;
// Default result
MOVI2R(SREG, 1);
// Compare
FCMPU(0, fpr.R(fs), fpr.R(ft));
if (unorderer) {
// 3 = UN
CROR(bf, bf, 3);
}
// If result is good jump
ptr = B_Cond(cond);
MOVI2R(SREG, 0);
SetJumpTarget(ptr);
}
/** https://github.com/gligli/mupen64-360/blob/42bf04f370f00f16be17f3ba9f74b420a7d86422/source/r4300/ppc/MIPS-to-PPC.c#L2916 **/
/**
Condition-Register Field and Floating-Point Condition Code Interpretation
Bit Name Description
0 FL (FRA) < (FRB)
1 FG (FRA) > (FRB)
2 FE (FRA) = (FRB)
3 FU (FRA) ? (FRB) (unordered)
**/
void Jit::Comp_FPUComp(MIPSOpcode op) {
CONDITIONAL_DISABLE;
int opc = op & 0xF;
if (opc >= 8) opc -= 8; // alias
if (opc == 0) { // f, sf (signalling false)
MOVI2R(SREG, 0);
STW(SREG, CTXREG, offsetof(MIPSState, fpcond));
return;
}
int fs = _FS;
int ft = _FT;
fpr.MapInIn(fs, ft);
switch(opc)
{
// FAIL
case 1: // un, ngle (unordered)
DISABLE;
break;
// OK
case 2: //eq, seq (equal, ordered)
FPUComp(fs, ft, _BEQ);
break;
// FAIL
case 3: // ueq, ngl (equal, unordered)
FPUComp(fs, ft, _BEQ, true, 2);
break;
// OK
case 4: // olt, lt (less than, ordered)
FPUComp(fs, ft, _BLT);
break;
// FAIL
case 5: // ult, nge (less than, unordered)
FPUComp(fs, ft, _BLT, true, 0);
break;
// OK
case 6: // ole, le (less equal, ordered)
FPUComp(fs, ft, _BLE, true, 1);
break;
// FAIL
case 7: // ule, ngt (less equal, unordered)
FPUComp(fs, ft, _BLE);
break;
default:
Comp_Generic(op);
return;
}
STW(SREG, CTXREG, offsetof(MIPSState, fpcond));
}
#endif
void Jit::Comp_FPU2op(MIPSOpcode op) {
DISABLE
CONDITIONAL_DISABLE;
int fs = _FS;
int fd = _FD;
switch (op & 0x3f)
{
case 4: //F(fd) = sqrtf(F(fs)); break; //sqrt
fpr.MapDirtyIn(fd, fs);
FSQRTS(fpr.R(fd), fpr.R(fs));
break;
case 5: //F(fd) = fabsf(F(fs)); break; //abs
fpr.MapDirtyIn(fd, fs);
FABS(fpr.R(fd), fpr.R(fs));
break;
case 6: //F(fd) = F(fs); break; //mov
fpr.MapDirtyIn(fd, fs);
FMR(fpr.R(fd), fpr.R(fs));
break;
case 7: //F(fd) = -F(fs); break; //neg
fpr.MapDirtyIn(fd, fs);
FNEG(fpr.R(fd), fpr.R(fs));
break;
case 13: // FsI(fd) = F(fs)>=0 ? (int)floorf(F(fs)) : (int)ceilf(F(fs)); break; //trunc.w.s
fpr.MapDirtyIn(fd, fs);
FRIZ(fpr.R(fd), fpr.R(fs));
break;
/*
case 12: // FsI(fd) = (int)floorf(F(fs)+0.5f); break; //round.w.s
case 14: // FsI(fd) = (int)ceilf (F(fs)); break; //ceil.w.s
case 15: // FsI(fd) = (int)floorf(F(fs)); break; //floor.w.s
case 32: // F(fd) = (float)FsI(fs); break; //cvt.s.w
case 36:
//switch (currentMIPS->fcr31 & 3)
//{
//case 0: FsI(fd) = (int)round_ieee_754(F(fs)); break; // RINT_0
//case 1: FsI(fd) = (int)F(fs); break; // CAST_1
//case 2: FsI(fd) = (int)ceilf(F(fs)); break; // CEIL_2
//case 3: FsI(fd) = (int)floorf(F(fs)); break; // FLOOR_3
//}
//break; //cvt.w.s
*/
default:
Comp_Generic(op);
break;
}
}
/**
Seem to work
**/
void Jit::Comp_mxc1(MIPSOpcode op) {
CONDITIONAL_DISABLE;
int fs = _FS;
MIPSGPReg rt = _RT;
switch ((op >> 21) & 0x1f)
{
case 0: // R(rt) = FI(fs); break; //mfc1
// Let's just go through RAM for now.
fpr.FlushR(fs);
gpr.MapReg(rt, MAP_DIRTY | MAP_NOINIT);
LWZ(gpr.R(rt), CTXREG, fpr.GetMipsRegOffset(fs));
return;
case 2: //cfc1
if (fs == 31)
{
/* Todo Lazy code ! */
gpr.MapReg(rt, MAP_DIRTY | MAP_NOINIT);
PPCReg _rt = gpr.R(rt);
// SREG = fpcond & 1;
LWZ(SREG, CTXREG, offsetof(MIPSState, fpcond));
ANDI(SREG, SREG, 1); // Just in case
// SREG << 23
SLWI(SREG, SREG, 23);
// RT = fcr31 & ~(1<<23)
LWZ(_rt, CTXREG, offsetof(MIPSState, fcr31));
RLWINM(_rt, _rt, 0, 9, 7);
// RT = RT | SREG
OR(_rt, _rt, SREG);
} else if (fs == 0) {
gpr.SetImm(rt, MIPSState::FCR0_VALUE);
} else {
// Unsupported regs are always 0.
gpr.SetImm(rt, 0);
}
return;
case 4: //FI(fs) = R(rt); break; //mtc1
// Let's just go through RAM for now.
gpr.FlushR(rt);
fpr.MapReg(fs, MAP_DIRTY | MAP_NOINIT);
LFS(fpr.R(fs), CTXREG, gpr.GetMipsRegOffset(rt));
return;
case 6: //ctc1
if (fs == 31)
{
gpr.MapReg(rt, 0);
// Update MIPS state
// fcr31 = rt
STW(gpr.R(rt), CTXREG, offsetof(MIPSState, fcr31));
// fpcond = (rt >> 23) & 1;
SRWI(SREG, gpr.R(rt), 23);
ANDI(SREG, SREG, 1);
STW(SREG, CTXREG, offsetof(MIPSState, fpcond));
}
return;
}
}
}