2012-11-15 00:39:56 +01:00
|
|
|
#pragma once
|
|
|
|
|
|
2013-07-04 16:20:36 +02:00
|
|
|
#define UNIMPLEMENTED() UNK(__FUNCTION__)
|
2012-11-15 00:39:56 +01:00
|
|
|
|
2014-04-12 12:27:27 +02:00
|
|
|
#define MEM_AND_REG_HASH() \
|
2014-10-02 12:29:20 +02:00
|
|
|
unsigned char mem_h[20]; sha1(vm::get_ptr<u8>(CPU.ls_offset), 256*1024, mem_h); \
|
2014-04-12 12:27:27 +02:00
|
|
|
unsigned char reg_h[20]; sha1((const unsigned char*)CPU.GPR, sizeof(CPU.GPR), reg_h); \
|
2014-06-27 15:26:46 +02:00
|
|
|
LOG_NOTICE(Log::SPU, "Mem hash: 0x%llx, reg hash: 0x%llx", *(u64*)mem_h, *(u64*)reg_h);
|
2014-04-12 12:27:27 +02:00
|
|
|
|
2014-06-27 15:26:46 +02:00
|
|
|
#define LOG2_OPCODE(...) //MEM_AND_REG_HASH(); LOG_NOTICE(Log::SPU, __FUNCTION__ "(): " __VA_ARGS__)
|
2014-04-17 01:28:21 +02:00
|
|
|
|
|
|
|
|
#define LOG5_OPCODE(...) ///
|
2014-04-07 15:06:13 +02:00
|
|
|
|
2013-11-03 20:23:16 +01:00
|
|
|
class SPUInterpreter : public SPUOpcodes
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
private:
|
|
|
|
|
SPUThread& CPU;
|
|
|
|
|
|
|
|
|
|
public:
|
2013-11-03 20:23:16 +01:00
|
|
|
SPUInterpreter(SPUThread& cpu) : CPU(cpu)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
private:
|
2013-07-04 16:20:36 +02:00
|
|
|
void SysCall()
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//0 - 10
|
2013-07-04 16:20:36 +02:00
|
|
|
void STOP(u32 code)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-08-22 16:21:55 +02:00
|
|
|
CPU.StopAndSignal(code);
|
2014-04-17 01:28:21 +02:00
|
|
|
LOG2_OPCODE();
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void LNOP()
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SYNC(u32 Cbit)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-04-06 21:23:32 +02:00
|
|
|
// This instruction must be used following a store instruction that modifies the instruction stream.
|
2013-12-22 18:40:50 +01:00
|
|
|
_mm_mfence();
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DSYNC()
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-04-06 21:23:32 +02:00
|
|
|
// This instruction forces all earlier load, store, and channel instructions to complete before proceeding.
|
2013-12-22 18:40:50 +01:00
|
|
|
_mm_mfence();
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MFSPR(u32 rt, u32 sa)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2015-01-18 19:18:36 +01:00
|
|
|
CPU.GPR[rt].clear(); // All SPRs read as zero.
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void RDCH(u32 rt, u32 ra)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
CPU.ReadChannel(CPU.GPR[rt], ra);
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void RCHCNT(u32 rt, u32 ra)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt].clear();
|
2013-07-06 01:49:38 +02:00
|
|
|
CPU.GPR[rt]._u32[3] = CPU.GetChannelCount(ra);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SF(u32 rt, u32 ra, u32 rb)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-08 18:44:52 +01:00
|
|
|
CPU.GPR[rt]._u32[0] = CPU.GPR[rb]._u32[0] - CPU.GPR[ra]._u32[0];
|
|
|
|
|
CPU.GPR[rt]._u32[1] = CPU.GPR[rb]._u32[1] - CPU.GPR[ra]._u32[1];
|
|
|
|
|
CPU.GPR[rt]._u32[2] = CPU.GPR[rb]._u32[2] - CPU.GPR[ra]._u32[2];
|
|
|
|
|
CPU.GPR[rt]._u32[3] = CPU.GPR[rb]._u32[3] - CPU.GPR[ra]._u32[3];
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void OR(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-08 18:44:52 +01:00
|
|
|
CPU.GPR[rt]._u32[0] = CPU.GPR[ra]._u32[0] | CPU.GPR[rb]._u32[0];
|
|
|
|
|
CPU.GPR[rt]._u32[1] = CPU.GPR[ra]._u32[1] | CPU.GPR[rb]._u32[1];
|
|
|
|
|
CPU.GPR[rt]._u32[2] = CPU.GPR[ra]._u32[2] | CPU.GPR[rb]._u32[2];
|
|
|
|
|
CPU.GPR[rt]._u32[3] = CPU.GPR[ra]._u32[3] | CPU.GPR[rb]._u32[3];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void BG(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u32[0] = CPU.GPR[ra]._u32[0] > CPU.GPR[rb]._u32[0] ? 0 : 1;
|
|
|
|
|
CPU.GPR[rt]._u32[1] = CPU.GPR[ra]._u32[1] > CPU.GPR[rb]._u32[1] ? 0 : 1;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = CPU.GPR[ra]._u32[2] > CPU.GPR[rb]._u32[2] ? 0 : 1;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = CPU.GPR[ra]._u32[3] > CPU.GPR[rb]._u32[3] ? 0 : 1;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SFH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-08 18:44:52 +01:00
|
|
|
for (int h = 0; h < 8; h++)
|
|
|
|
|
CPU.GPR[rt]._u16[h] = CPU.GPR[rb]._u16[h] - CPU.GPR[ra]._u16[h];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void NOR(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-08 18:44:52 +01:00
|
|
|
CPU.GPR[rt]._u32[0] = ~(CPU.GPR[ra]._u32[0] | CPU.GPR[rb]._u32[0]);
|
|
|
|
|
CPU.GPR[rt]._u32[1] = ~(CPU.GPR[ra]._u32[1] | CPU.GPR[rb]._u32[1]);
|
|
|
|
|
CPU.GPR[rt]._u32[2] = ~(CPU.GPR[ra]._u32[2] | CPU.GPR[rb]._u32[2]);
|
|
|
|
|
CPU.GPR[rt]._u32[3] = ~(CPU.GPR[ra]._u32[3] | CPU.GPR[rb]._u32[3]);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ABSDB(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-08 18:44:52 +01:00
|
|
|
for (int b = 0; b < 16; b++)
|
|
|
|
|
CPU.GPR[rt]._u8[b] = CPU.GPR[rb]._u8[b] > CPU.GPR[ra]._u8[b] ? CPU.GPR[rb]._u8[b] - CPU.GPR[ra]._u8[b] : CPU.GPR[ra]._u8[b] - CPU.GPR[rb]._u8[b];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROT(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u32[0] = (CPU.GPR[ra]._u32[0] << (CPU.GPR[rb]._u32[0] & 0x1f)) | (CPU.GPR[ra]._u32[0] >> (32 - (CPU.GPR[rb]._u32[0] & 0x1f)));
|
|
|
|
|
CPU.GPR[rt]._u32[1] = (CPU.GPR[ra]._u32[1] << (CPU.GPR[rb]._u32[1] & 0x1f)) | (CPU.GPR[ra]._u32[1] >> (32 - (CPU.GPR[rb]._u32[1] & 0x1f)));
|
|
|
|
|
CPU.GPR[rt]._u32[2] = (CPU.GPR[ra]._u32[2] << (CPU.GPR[rb]._u32[2] & 0x1f)) | (CPU.GPR[ra]._u32[2] >> (32 - (CPU.GPR[rb]._u32[2] & 0x1f)));
|
|
|
|
|
CPU.GPR[rt]._u32[3] = (CPU.GPR[ra]._u32[3] << (CPU.GPR[rb]._u32[3] & 0x1f)) | (CPU.GPR[ra]._u32[3] >> (32 - (CPU.GPR[rb]._u32[3] & 0x1f)));
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTM(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-04-12 12:27:27 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = ((0 - CPU.GPR[rb]._u32[0]) & 0x3f) < 32 ? CPU.GPR[ra]._u32[0] >> ((0 - CPU.GPR[rb]._u32[0]) & 0x3f) : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[1] = ((0 - CPU.GPR[rb]._u32[1]) & 0x3f) < 32 ? CPU.GPR[ra]._u32[1] >> ((0 - CPU.GPR[rb]._u32[1]) & 0x3f) : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = ((0 - CPU.GPR[rb]._u32[2]) & 0x3f) < 32 ? CPU.GPR[ra]._u32[2] >> ((0 - CPU.GPR[rb]._u32[2]) & 0x3f) : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = ((0 - CPU.GPR[rb]._u32[3]) & 0x3f) < 32 ? CPU.GPR[ra]._u32[3] >> ((0 - CPU.GPR[rb]._u32[3]) & 0x3f) : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTMA(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[0] = ((0 - CPU.GPR[rb]._u32[0]) & 0x3f) < 32 ? CPU.GPR[ra]._s32[0] >> ((0 - CPU.GPR[rb]._u32[0]) & 0x3f) : CPU.GPR[ra]._s32[0] >> 31;
|
|
|
|
|
CPU.GPR[rt]._s32[1] = ((0 - CPU.GPR[rb]._u32[1]) & 0x3f) < 32 ? CPU.GPR[ra]._s32[1] >> ((0 - CPU.GPR[rb]._u32[1]) & 0x3f) : CPU.GPR[ra]._s32[1] >> 31;
|
|
|
|
|
CPU.GPR[rt]._s32[2] = ((0 - CPU.GPR[rb]._u32[2]) & 0x3f) < 32 ? CPU.GPR[ra]._s32[2] >> ((0 - CPU.GPR[rb]._u32[2]) & 0x3f) : CPU.GPR[ra]._s32[2] >> 31;
|
|
|
|
|
CPU.GPR[rt]._s32[3] = ((0 - CPU.GPR[rb]._u32[3]) & 0x3f) < 32 ? CPU.GPR[ra]._s32[3] >> ((0 - CPU.GPR[rb]._u32[3]) & 0x3f) : CPU.GPR[ra]._s32[3] >> 31;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SHL(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u32[0] = (CPU.GPR[rb]._u32[0] & 0x3f) > 31 ? 0 : CPU.GPR[ra]._u32[0] << (CPU.GPR[rb]._u32[0] & 0x3f);
|
|
|
|
|
CPU.GPR[rt]._u32[1] = (CPU.GPR[rb]._u32[1] & 0x3f) > 31 ? 0 : CPU.GPR[ra]._u32[1] << (CPU.GPR[rb]._u32[1] & 0x3f);
|
|
|
|
|
CPU.GPR[rt]._u32[2] = (CPU.GPR[rb]._u32[2] & 0x3f) > 31 ? 0 : CPU.GPR[ra]._u32[2] << (CPU.GPR[rb]._u32[2] & 0x3f);
|
|
|
|
|
CPU.GPR[rt]._u32[3] = (CPU.GPR[rb]._u32[3] & 0x3f) > 31 ? 0 : CPU.GPR[ra]._u32[3] << (CPU.GPR[rb]._u32[3] & 0x3f);
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-02-01 11:17:15 +01:00
|
|
|
CPU.GPR[rt]._u16[h] = (CPU.GPR[ra]._u16[h] << (CPU.GPR[rb]._u16[h] & 0xf)) | (CPU.GPR[ra]._u16[h] >> (16 - (CPU.GPR[rb]._u16[h] & 0xf)));
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTHM(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-04-12 12:27:27 +02:00
|
|
|
CPU.GPR[rt]._u16[h] = ((0 - CPU.GPR[rb]._u16[h]) & 0x1f) < 16 ? CPU.GPR[ra]._u16[h] >> ((0 - CPU.GPR[rb]._u16[h]) & 0x1f) : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTMAH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s16[h] = ((0 - CPU.GPR[rb]._u16[h]) & 0x1f) < 16 ? CPU.GPR[ra]._s16[h] >> ((0 - CPU.GPR[rb]._u16[h]) & 0x1f) : CPU.GPR[ra]._s16[h] >> 15;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SHLH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-03-01 19:11:58 +01:00
|
|
|
CPU.GPR[rt]._u16[h] = (CPU.GPR[rb]._u16[h] & 0x1f) > 15 ? 0 : CPU.GPR[ra]._u16[h] << (CPU.GPR[rb]._u16[h] & 0x1f);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTI(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
const int nRot = i7 & 0x1f;
|
|
|
|
|
CPU.GPR[rt]._u32[0] = (CPU.GPR[ra]._u32[0] << nRot) | (CPU.GPR[ra]._u32[0] >> (32 - nRot));
|
|
|
|
|
CPU.GPR[rt]._u32[1] = (CPU.GPR[ra]._u32[1] << nRot) | (CPU.GPR[ra]._u32[1] >> (32 - nRot));
|
|
|
|
|
CPU.GPR[rt]._u32[2] = (CPU.GPR[ra]._u32[2] << nRot) | (CPU.GPR[ra]._u32[2] >> (32 - nRot));
|
|
|
|
|
CPU.GPR[rt]._u32[3] = (CPU.GPR[ra]._u32[3] << nRot) | (CPU.GPR[ra]._u32[3] >> (32 - nRot));
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTMI(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-04-12 12:27:27 +02:00
|
|
|
const int nRot = (0 - i7) & 0x3f;
|
2013-06-30 10:46:29 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = nRot < 32 ? CPU.GPR[ra]._u32[0] >> nRot : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[1] = nRot < 32 ? CPU.GPR[ra]._u32[1] >> nRot : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = nRot < 32 ? CPU.GPR[ra]._u32[2] >> nRot : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = nRot < 32 ? CPU.GPR[ra]._u32[3] >> nRot : 0;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTMAI(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-04-12 12:27:27 +02:00
|
|
|
const int nRot = (0 - i7) & 0x3f;
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[0] = nRot < 32 ? CPU.GPR[ra]._s32[0] >> nRot : CPU.GPR[ra]._s32[0] >> 31;
|
|
|
|
|
CPU.GPR[rt]._s32[1] = nRot < 32 ? CPU.GPR[ra]._s32[1] >> nRot : CPU.GPR[ra]._s32[1] >> 31;
|
|
|
|
|
CPU.GPR[rt]._s32[2] = nRot < 32 ? CPU.GPR[ra]._s32[2] >> nRot : CPU.GPR[ra]._s32[2] >> 31;
|
|
|
|
|
CPU.GPR[rt]._s32[3] = nRot < 32 ? CPU.GPR[ra]._s32[3] >> nRot : CPU.GPR[ra]._s32[3] >> 31;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SHLI(u32 rt, u32 ra, s32 i7)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
const u32 s = i7 & 0x3f;
|
|
|
|
|
|
2013-12-23 12:57:09 +01:00
|
|
|
for (u32 j = 0; j < 4; ++j)
|
2014-04-12 12:27:27 +02:00
|
|
|
CPU.GPR[rt]._u32[j] = (s >= 32) ? 0 : CPU.GPR[ra]._u32[j] << s;
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTHI(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
const int nRot = i7 & 0xf;
|
|
|
|
|
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
|
|
|
|
CPU.GPR[rt]._u16[h] = (CPU.GPR[ra]._u16[h] << nRot) | (CPU.GPR[ra]._u16[h] >> (16 - nRot));
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTHMI(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-04-12 12:27:27 +02:00
|
|
|
const int nRot = (0 - i7) & 0x1f;
|
2013-06-30 10:46:29 +02:00
|
|
|
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
|
|
|
|
CPU.GPR[rt]._u16[h] = nRot < 16 ? CPU.GPR[ra]._u16[h] >> nRot : 0;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTMAHI(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-04-12 12:27:27 +02:00
|
|
|
const int nRot = (0 - i7) & 0x1f;
|
2013-06-30 10:46:29 +02:00
|
|
|
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s16[h] = nRot < 16 ? CPU.GPR[ra]._s16[h] >> nRot : CPU.GPR[ra]._s16[h] >> 15;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SHLHI(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
const int nRot = i7 & 0x1f;
|
|
|
|
|
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-04-12 12:27:27 +02:00
|
|
|
CPU.GPR[rt]._u16[h] = nRot > 15 ? 0 : CPU.GPR[ra]._u16[h] << nRot;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void A(u32 rt, u32 ra, u32 rb)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u32[0] = CPU.GPR[ra]._u32[0] + CPU.GPR[rb]._u32[0];
|
|
|
|
|
CPU.GPR[rt]._u32[1] = CPU.GPR[ra]._u32[1] + CPU.GPR[rb]._u32[1];
|
|
|
|
|
CPU.GPR[rt]._u32[2] = CPU.GPR[ra]._u32[2] + CPU.GPR[rb]._u32[2];
|
|
|
|
|
CPU.GPR[rt]._u32[3] = CPU.GPR[ra]._u32[3] + CPU.GPR[rb]._u32[3];
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void AND(u32 rt, u32 ra, u32 rb)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u32[0] = CPU.GPR[ra]._u32[0] & CPU.GPR[rb]._u32[0];
|
|
|
|
|
CPU.GPR[rt]._u32[1] = CPU.GPR[ra]._u32[1] & CPU.GPR[rb]._u32[1];
|
|
|
|
|
CPU.GPR[rt]._u32[2] = CPU.GPR[ra]._u32[2] & CPU.GPR[rb]._u32[2];
|
|
|
|
|
CPU.GPR[rt]._u32[3] = CPU.GPR[ra]._u32[3] & CPU.GPR[rb]._u32[3];
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CG(u32 rt, u32 ra, u32 rb)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-06-30 10:46:29 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = ((CPU.GPR[ra]._u32[0] + CPU.GPR[rb]._u32[0]) < CPU.GPR[ra]._u32[0]) ? 1 : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[1] = ((CPU.GPR[ra]._u32[1] + CPU.GPR[rb]._u32[1]) < CPU.GPR[ra]._u32[1]) ? 1 : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = ((CPU.GPR[ra]._u32[2] + CPU.GPR[rb]._u32[2]) < CPU.GPR[ra]._u32[2]) ? 1 : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = ((CPU.GPR[ra]._u32[3] + CPU.GPR[rb]._u32[3]) < CPU.GPR[ra]._u32[3]) ? 1 : 0;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void AH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
|
|
|
|
CPU.GPR[rt]._u16[h] = CPU.GPR[ra]._u16[h] + CPU.GPR[rb]._u16[h];
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void NAND(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u32[0] = ~(CPU.GPR[ra]._u32[0] & CPU.GPR[rb]._u32[0]);
|
|
|
|
|
CPU.GPR[rt]._u32[1] = ~(CPU.GPR[ra]._u32[1] & CPU.GPR[rb]._u32[1]);
|
|
|
|
|
CPU.GPR[rt]._u32[2] = ~(CPU.GPR[ra]._u32[2] & CPU.GPR[rb]._u32[2]);
|
|
|
|
|
CPU.GPR[rt]._u32[3] = ~(CPU.GPR[ra]._u32[3] & CPU.GPR[rb]._u32[3]);
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void AVGB(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
|
|
|
|
CPU.GPR[rt]._u8[b] = (CPU.GPR[ra]._u8[b] + CPU.GPR[rb]._u8[b] + 1) >> 1;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MTSPR(u32 rt, u32 sa)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2015-01-18 19:18:36 +01:00
|
|
|
// SPR writes are ignored.
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void WRCH(u32 ra, u32 rt)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
CPU.WriteChannel(ra, CPU.GPR[rt]);
|
|
|
|
|
}
|
2014-08-18 02:23:05 +02:00
|
|
|
void BIZ(u32 intr, u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
switch (intr)
|
2014-08-18 02:23:05 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
case 0: break;
|
|
|
|
|
case 0x10: break; // enable interrupts
|
|
|
|
|
case 0x20: break; // disable interrupts
|
|
|
|
|
default: UNIMPLEMENTED(); return;
|
2014-08-18 02:23:05 +02:00
|
|
|
}
|
|
|
|
|
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.GPR[ra]._u32[3], 0);
|
2014-04-07 15:06:13 +02:00
|
|
|
if (CPU.GPR[rt]._u32[3] == 0)
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("not taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2014-08-18 02:23:05 +02:00
|
|
|
void BINZ(u32 intr, u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
switch (intr)
|
2014-08-18 02:23:05 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
case 0: break;
|
|
|
|
|
case 0x10: break; // enable interrupts
|
|
|
|
|
case 0x20: break; // disable interrupts
|
|
|
|
|
default: UNIMPLEMENTED(); return;
|
2014-08-18 02:23:05 +02:00
|
|
|
}
|
|
|
|
|
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.GPR[ra]._u32[3], 0);
|
2014-04-07 15:06:13 +02:00
|
|
|
if (CPU.GPR[rt]._u32[3] != 0)
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("not taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2014-08-18 02:23:05 +02:00
|
|
|
void BIHZ(u32 intr, u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
switch (intr)
|
2014-08-18 02:23:05 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
case 0: break;
|
|
|
|
|
case 0x10: break; // enable interrupts
|
|
|
|
|
case 0x20: break; // disable interrupts
|
|
|
|
|
default: UNIMPLEMENTED(); return;
|
2014-08-18 02:23:05 +02:00
|
|
|
}
|
|
|
|
|
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.GPR[ra]._u32[3], 0);
|
2014-04-07 15:06:13 +02:00
|
|
|
if (CPU.GPR[rt]._u16[6] == 0)
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("not taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2014-08-18 02:23:05 +02:00
|
|
|
void BIHNZ(u32 intr, u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
switch (intr)
|
2014-08-18 02:23:05 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
case 0: break;
|
|
|
|
|
case 0x10: break; // enable interrupts
|
|
|
|
|
case 0x20: break; // disable interrupts
|
|
|
|
|
default: UNIMPLEMENTED(); return;
|
2014-08-18 02:23:05 +02:00
|
|
|
}
|
|
|
|
|
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.GPR[ra]._u32[3], 0);
|
2014-04-07 15:06:13 +02:00
|
|
|
if (CPU.GPR[rt]._u16[6] != 0)
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("not taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void STOPD(u32 rc, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
UNIMPLEMENTED(); // not used
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void STQX(u32 rt, u32 ra, u32 rb)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
u32 lsa = (CPU.GPR[ra]._u32[3] + CPU.GPR[rb]._u32[3]) & 0x3fff0;
|
2013-11-23 19:50:54 +01:00
|
|
|
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.WriteLS128(lsa, CPU.GPR[rt]);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2014-08-18 02:23:05 +02:00
|
|
|
void BI(u32 intr, u32 ra)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
switch (intr)
|
2014-08-18 02:23:05 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
case 0: break;
|
|
|
|
|
case 0x10: break; // enable interrupts
|
|
|
|
|
case 0x20: break; // disable interrupts
|
|
|
|
|
default: UNIMPLEMENTED(); return;
|
2014-08-18 02:23:05 +02:00
|
|
|
}
|
|
|
|
|
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.GPR[ra]._u32[3], 0);
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("branch (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2014-08-18 02:23:05 +02:00
|
|
|
void BISL(u32 intr, u32 rt, u32 ra)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
switch (intr)
|
2014-08-18 02:23:05 +02:00
|
|
|
{
|
2014-10-09 23:38:02 +02:00
|
|
|
case 0: break;
|
|
|
|
|
case 0x10: break; // enable interrupts
|
|
|
|
|
case 0x20: break; // disable interrupts
|
|
|
|
|
default: UNIMPLEMENTED(); return;
|
2014-08-18 02:23:05 +02:00
|
|
|
}
|
|
|
|
|
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.GPR[ra]._u32[3], 0);
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt].clear();
|
2014-09-15 00:17:24 +02:00
|
|
|
CPU.GPR[rt]._u32[3] = CPU.PC + 4;
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("branch (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void IRET(u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
UNIMPLEMENTED(); // not used
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2014-08-18 02:23:05 +02:00
|
|
|
void BISLED(u32 intr, u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
UNIMPLEMENTED(); // not used
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void HBR(u32 p, u32 ro, u32 ra)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void GB(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u32[3] = (CPU.GPR[ra]._u32[0] & 1) |
|
2013-06-30 10:46:29 +02:00
|
|
|
((CPU.GPR[ra]._u32[1] & 1) << 1) |
|
|
|
|
|
((CPU.GPR[ra]._u32[2] & 1) << 2) |
|
|
|
|
|
((CPU.GPR[ra]._u32[3] & 1) << 3);
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u32[2] = 0;
|
|
|
|
|
CPU.GPR[rt]._u64[0] = 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void GBH(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
u32 temp = 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
for (int h = 0; h < 8; h++)
|
2013-12-01 18:30:40 +01:00
|
|
|
temp |= (CPU.GPR[ra]._u16[h] & 1) << h;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = temp;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = 0;
|
|
|
|
|
CPU.GPR[rt]._u64[0] = 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void GBB(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-07 23:52:41 +01:00
|
|
|
u32 temp = 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
for (int b = 0; b < 16; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
temp |= (CPU.GPR[ra]._u8[b] & 1) << b;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = temp;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = 0;
|
|
|
|
|
CPU.GPR[rt]._u64[0] = 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FSM(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
const u32 pref = CPU.GPR[ra]._u32[3];
|
2013-06-30 10:46:29 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u32[w] = (pref & (1 << w)) ? ~0 : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FSMH(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
const u32 pref = CPU.GPR[ra]._u32[3];
|
2013-06-30 10:46:29 +02:00
|
|
|
for (int h = 0; h < 8; h++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u16[h] = (pref & (1 << h)) ? ~0 : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FSMB(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
const u32 pref = CPU.GPR[ra]._u32[3];
|
2013-06-30 10:46:29 +02:00
|
|
|
for (int b = 0; b < 16; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = (pref & (1 << b)) ? ~0 : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FREST(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-24 12:10:55 +01:00
|
|
|
//CPU.GPR[rt]._m128 = _mm_rcp_ps(CPU.GPR[ra]._m128);
|
|
|
|
|
for (int i = 0; i < 4; i++)
|
|
|
|
|
CPU.GPR[rt]._f[i] = 1 / CPU.GPR[ra]._f[i];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FRSQEST(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-24 12:10:55 +01:00
|
|
|
//const __u32x4 FloatAbsMask = {0x7fffffff, 0x7fffffff, 0x7fffffff, 0x7fffffff};
|
|
|
|
|
//CPU.GPR[rt]._m128 = _mm_rsqrt_ps(_mm_and_ps(CPU.GPR[ra]._m128, FloatAbsMask.m128));
|
|
|
|
|
for (int i = 0; i < 4; i++)
|
|
|
|
|
CPU.GPR[rt]._f[i] = 1 / sqrt(abs(CPU.GPR[ra]._f[i]));
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void LQX(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-10-04 16:43:46 +02:00
|
|
|
u32 lsa = (CPU.GPR[ra]._u32[3] + CPU.GPR[rb]._u32[3]) & 0x3fff0;
|
2013-12-07 23:52:41 +01:00
|
|
|
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt] = CPU.ReadLS128(lsa);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQBYBI(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = (CPU.GPR[rb]._u32[3] >> 3) & 0xf;
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
2013-12-01 01:36:55 +01:00
|
|
|
for (int b = 0; b < 16; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = temp._u8[(b - s) & 0xf];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQMBYBI(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = (0 - (CPU.GPR[rb]._u32[3] >> 3)) & 0x1f;
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
|
|
|
|
CPU.GPR[rt].clear();
|
2013-12-01 01:36:55 +01:00
|
|
|
for (int b = 0; b < 16 - s; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = temp._u8[b + s];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SHLQBYBI(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = (CPU.GPR[rb]._u32[3] >> 3) & 0x1f;
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
|
|
|
|
CPU.GPR[rt].clear();
|
2013-12-01 01:36:55 +01:00
|
|
|
for (int b = s; b < 16; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = temp._u8[b - s];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CBX(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const u32 t = (CPU.GPR[rb]._u32[3] + CPU.GPR[ra]._u32[3]) & 0xF;
|
2013-06-30 10:46:29 +02:00
|
|
|
|
2014-10-28 13:30:37 +01:00
|
|
|
if (ra == 1 && (CPU.GPR[ra]._u32[3] & 0xF))
|
|
|
|
|
{
|
|
|
|
|
LOG_ERROR(SPU, "%s(): SP = 0x%x", __FUNCTION__, CPU.GPR[ra]._u32[3]);
|
|
|
|
|
Emu.Pause();
|
|
|
|
|
}
|
|
|
|
|
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u64[0] = (u64)0x18191A1B1C1D1E1F;
|
|
|
|
|
CPU.GPR[rt]._u64[1] = (u64)0x1011121314151617;
|
|
|
|
|
CPU.GPR[rt]._u8[15 - t] = 0x03;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CHX(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const u32 t = (CPU.GPR[rb]._u32[3] + CPU.GPR[ra]._u32[3]) & 0xE;
|
2013-06-30 10:46:29 +02:00
|
|
|
|
2014-10-28 13:30:37 +01:00
|
|
|
if (ra == 1 && (CPU.GPR[ra]._u32[3] & 0xF))
|
|
|
|
|
{
|
|
|
|
|
LOG_ERROR(SPU, "%s(): SP = 0x%x", __FUNCTION__, CPU.GPR[ra]._u32[3]);
|
|
|
|
|
Emu.Pause();
|
|
|
|
|
}
|
|
|
|
|
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u64[0] = (u64)0x18191A1B1C1D1E1F;
|
|
|
|
|
CPU.GPR[rt]._u64[1] = (u64)0x1011121314151617;
|
|
|
|
|
CPU.GPR[rt]._u16[7 - (t >> 1)] = 0x0203;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CWX(u32 rt, u32 ra, u32 rb)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const u32 t = (CPU.GPR[ra]._u32[3] + CPU.GPR[rb]._u32[3]) & 0xC;
|
2014-10-28 13:30:37 +01:00
|
|
|
|
|
|
|
|
if (ra == 1 && (CPU.GPR[ra]._u32[3] & 0xF))
|
|
|
|
|
{
|
|
|
|
|
LOG_ERROR(SPU, "%s(): SP = 0x%x", __FUNCTION__, CPU.GPR[ra]._u32[3]);
|
|
|
|
|
Emu.Pause();
|
|
|
|
|
}
|
2013-12-01 01:36:55 +01:00
|
|
|
|
|
|
|
|
CPU.GPR[rt]._u64[0] = (u64)0x18191A1B1C1D1E1F;
|
|
|
|
|
CPU.GPR[rt]._u64[1] = (u64)0x1011121314151617;
|
|
|
|
|
CPU.GPR[rt]._u32[3 - (t >> 2)] = 0x00010203;
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CDX(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const u32 t = (CPU.GPR[rb]._u32[3] + CPU.GPR[ra]._u32[3]) & 0x8;
|
2013-06-30 10:46:29 +02:00
|
|
|
|
2014-10-28 13:30:37 +01:00
|
|
|
if (ra == 1 && (CPU.GPR[ra]._u32[3] & 0xF))
|
|
|
|
|
{
|
|
|
|
|
LOG_ERROR(SPU, "%s(): SP = 0x%x", __FUNCTION__, CPU.GPR[ra]._u32[3]);
|
|
|
|
|
Emu.Pause();
|
|
|
|
|
}
|
|
|
|
|
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u64[0] = (u64)0x18191A1B1C1D1E1F;
|
|
|
|
|
CPU.GPR[rt]._u64[1] = (u64)0x1011121314151617;
|
|
|
|
|
CPU.GPR[rt]._u64[1 - (t >> 3)] = (u64)0x0001020304050607;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQBI(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int t = CPU.GPR[rb]._u32[3] & 0x7;
|
2014-07-16 14:13:11 +02:00
|
|
|
if (t) // not an optimization, it fixes shifts
|
|
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
2014-07-16 14:13:11 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = (temp._u32[0] << t) | (temp._u32[3] >> (32 - t));
|
|
|
|
|
CPU.GPR[rt]._u32[1] = (temp._u32[1] << t) | (temp._u32[0] >> (32 - t));
|
|
|
|
|
CPU.GPR[rt]._u32[2] = (temp._u32[2] << t) | (temp._u32[1] >> (32 - t));
|
|
|
|
|
CPU.GPR[rt]._u32[3] = (temp._u32[3] << t) | (temp._u32[2] >> (32 - t));
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt] = CPU.GPR[ra];
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQMBI(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int t = (0 - CPU.GPR[rb]._u32[3]) & 0x7;
|
2014-07-16 14:13:11 +02:00
|
|
|
if (t) // not an optimization, it fixes shifts
|
|
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
2014-07-16 14:13:11 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = (temp._u32[0] >> t) | (temp._u32[1] << (32 - t));
|
|
|
|
|
CPU.GPR[rt]._u32[1] = (temp._u32[1] >> t) | (temp._u32[2] << (32 - t));
|
|
|
|
|
CPU.GPR[rt]._u32[2] = (temp._u32[2] >> t) | (temp._u32[3] << (32 - t));
|
|
|
|
|
CPU.GPR[rt]._u32[3] = (temp._u32[3] >> t);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt] = CPU.GPR[ra];
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SHLQBI(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int t = CPU.GPR[rb]._u32[3] & 0x7;
|
2014-07-16 14:13:11 +02:00
|
|
|
if (t) // not an optimization, it fixes shifts
|
|
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
2014-07-16 14:13:11 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = (temp._u32[0] << t);
|
|
|
|
|
CPU.GPR[rt]._u32[1] = (temp._u32[1] << t) | (temp._u32[0] >> (32 - t));
|
|
|
|
|
CPU.GPR[rt]._u32[2] = (temp._u32[2] << t) | (temp._u32[1] >> (32 - t));
|
|
|
|
|
CPU.GPR[rt]._u32[3] = (temp._u32[3] << t) | (temp._u32[2] >> (32 - t));
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt] = CPU.GPR[ra];
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQBY(u32 rt, u32 ra, u32 rb)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = CPU.GPR[rb]._u32[3] & 0xf;
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
2013-12-01 01:36:55 +01:00
|
|
|
for (int b = 0; b < 16; ++b)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = temp._u8[(b - s) & 0xf];
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQMBY(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = (0 - CPU.GPR[rb]._u32[3]) & 0x1f;
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
|
|
|
|
CPU.GPR[rt].clear();
|
2013-12-01 01:36:55 +01:00
|
|
|
for (int b = 0; b < 16 - s; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = temp._u8[b + s];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SHLQBY(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = CPU.GPR[rb]._u32[3] & 0x1f;
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
|
|
|
|
CPU.GPR[rt].clear();
|
2013-12-01 01:36:55 +01:00
|
|
|
for (int b = s; b < 16; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = temp._u8[b - s];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ORX(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-02 11:40:58 +01:00
|
|
|
CPU.GPR[rt]._u32[3] = CPU.GPR[ra]._u32[0] | CPU.GPR[ra]._u32[1] | CPU.GPR[ra]._u32[2] | CPU.GPR[ra]._u32[3];
|
|
|
|
|
CPU.GPR[rt]._u32[2] = 0;
|
|
|
|
|
CPU.GPR[rt]._u64[0] = 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CBD(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int t = (CPU.GPR[ra]._u32[3] + i7) & 0xF;
|
2013-06-30 10:46:29 +02:00
|
|
|
|
2014-10-28 13:30:37 +01:00
|
|
|
if (ra == 1 && (CPU.GPR[ra]._u32[3] & 0xF))
|
|
|
|
|
{
|
|
|
|
|
LOG_ERROR(SPU, "%s(): SP = 0x%x", __FUNCTION__, CPU.GPR[ra]._u32[3]);
|
|
|
|
|
Emu.Pause();
|
|
|
|
|
}
|
|
|
|
|
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u64[0] = (u64)0x18191A1B1C1D1E1F;
|
|
|
|
|
CPU.GPR[rt]._u64[1] = (u64)0x1011121314151617;
|
|
|
|
|
CPU.GPR[rt]._u8[15 - t] = 0x03;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CHD(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int t = (CPU.GPR[ra]._u32[3] + i7) & 0xE;
|
2013-06-30 10:46:29 +02:00
|
|
|
|
2014-10-28 13:30:37 +01:00
|
|
|
if (ra == 1 && (CPU.GPR[ra]._u32[3] & 0xF))
|
|
|
|
|
{
|
|
|
|
|
LOG_ERROR(SPU, "%s(): SP = 0x%x", __FUNCTION__, CPU.GPR[ra]._u32[3]);
|
|
|
|
|
Emu.Pause();
|
|
|
|
|
}
|
|
|
|
|
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u64[0] = (u64)0x18191A1B1C1D1E1F;
|
|
|
|
|
CPU.GPR[rt]._u64[1] = (u64)0x1011121314151617;
|
|
|
|
|
CPU.GPR[rt]._u16[7 - (t >> 1)] = 0x0203;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CWD(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int t = (CPU.GPR[ra]._u32[3] + i7) & 0xC;
|
2013-06-30 10:46:29 +02:00
|
|
|
|
2014-10-28 13:30:37 +01:00
|
|
|
if (ra == 1 && (CPU.GPR[ra]._u32[3] & 0xF))
|
|
|
|
|
{
|
|
|
|
|
LOG_ERROR(SPU, "%s(): SP = 0x%x", __FUNCTION__, CPU.GPR[ra]._u32[3]);
|
|
|
|
|
Emu.Pause();
|
|
|
|
|
}
|
|
|
|
|
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u64[0] = (u64)0x18191A1B1C1D1E1F;
|
|
|
|
|
CPU.GPR[rt]._u64[1] = (u64)0x1011121314151617;
|
|
|
|
|
CPU.GPR[rt]._u32[3 - (t >> 2)] = 0x00010203;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CDD(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int t = (CPU.GPR[ra]._u32[3] + i7) & 0x8;
|
2013-06-30 10:46:29 +02:00
|
|
|
|
2014-10-28 13:30:37 +01:00
|
|
|
if (ra == 1 && (CPU.GPR[ra]._u32[3] & 0xF))
|
|
|
|
|
{
|
|
|
|
|
LOG_ERROR(SPU, "%s(): SP = 0x%x", __FUNCTION__, CPU.GPR[ra]._u32[3]);
|
|
|
|
|
Emu.Pause();
|
|
|
|
|
}
|
|
|
|
|
|
2013-11-30 00:40:31 +01:00
|
|
|
CPU.GPR[rt]._u64[0] = (u64)0x18191A1B1C1D1E1F;
|
|
|
|
|
CPU.GPR[rt]._u64[1] = (u64)0x1011121314151617;
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u64[1 - (t >> 3)] = (u64)0x0001020304050607;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQBII(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = i7 & 0x7;
|
2014-07-16 14:13:11 +02:00
|
|
|
if (s) // not an optimization, it fixes shifts
|
|
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
2014-07-16 14:13:11 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = (temp._u32[0] << s) | (temp._u32[3] >> (32 - s));
|
|
|
|
|
CPU.GPR[rt]._u32[1] = (temp._u32[1] << s) | (temp._u32[0] >> (32 - s));
|
|
|
|
|
CPU.GPR[rt]._u32[2] = (temp._u32[2] << s) | (temp._u32[1] >> (32 - s));
|
|
|
|
|
CPU.GPR[rt]._u32[3] = (temp._u32[3] << s) | (temp._u32[2] >> (32 - s));
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt] = CPU.GPR[ra];
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQMBII(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = (0 - i7) & 0x7;
|
2014-07-16 14:13:11 +02:00
|
|
|
if (s) // not an optimization, it fixes shifts
|
|
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
2014-07-16 14:13:11 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = (temp._u32[0] >> s) | (temp._u32[1] << (32 - s));
|
|
|
|
|
CPU.GPR[rt]._u32[1] = (temp._u32[1] >> s) | (temp._u32[2] << (32 - s));
|
|
|
|
|
CPU.GPR[rt]._u32[2] = (temp._u32[2] >> s) | (temp._u32[3] << (32 - s));
|
|
|
|
|
CPU.GPR[rt]._u32[3] = (temp._u32[3] >> s);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt] = CPU.GPR[ra];
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SHLQBII(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = i7 & 0x7;
|
2014-07-16 14:13:11 +02:00
|
|
|
if (s) // not an optimization, it fixes shifts
|
|
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
2014-07-16 14:13:11 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = (temp._u32[0] << s);
|
|
|
|
|
CPU.GPR[rt]._u32[1] = (temp._u32[1] << s) | (temp._u32[0] >> (32 - s));
|
|
|
|
|
CPU.GPR[rt]._u32[2] = (temp._u32[2] << s) | (temp._u32[1] >> (32 - s));
|
|
|
|
|
CPU.GPR[rt]._u32[3] = (temp._u32[3] << s) | (temp._u32[2] >> (32 - s));
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt] = CPU.GPR[ra];
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQBYI(u32 rt, u32 ra, s32 i7)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = i7 & 0xf;
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
2013-12-01 01:36:55 +01:00
|
|
|
for (int b = 0; b < 16; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = temp._u8[(b - s) & 0xf];
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ROTQMBYI(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = (0 - i7) & 0x1f;
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
|
|
|
|
CPU.GPR[rt].clear();
|
2013-12-01 01:36:55 +01:00
|
|
|
for (int b = 0; b < 16 - s; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = temp._u8[b + s];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SHLQBYI(u32 rt, u32 ra, s32 i7)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
const int s = i7 & 0x1f;
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
|
|
|
|
CPU.GPR[rt].clear();
|
2013-12-01 01:36:55 +01:00
|
|
|
for (int b = s; b < 16; b++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] = temp._u8[b - s];
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void NOP(u32 rt)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CGT(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._s32[w] > CPU.GPR[rb]._s32[w] ? 0xffffffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void XOR(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._u32[w] ^ CPU.GPR[rb]._u32[w];
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CGTH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._u16[h] = CPU.GPR[ra]._s16[h] > CPU.GPR[rb]._s16[h] ? 0xffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void EQV(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._u32[w] ^ (~CPU.GPR[rb]._u32[w]);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CGTB(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._u8[b] = CPU.GPR[ra]._s8[b] > CPU.GPR[rb]._s8[b] ? 0xff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SUMB(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 _a = CPU.GPR[ra];
|
|
|
|
|
const u128 _b = CPU.GPR[rb];
|
2013-06-30 10:46:29 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u16[w*2] = _a._u8[w*4] + _a._u8[w*4 + 1] + _a._u8[w*4 + 2] + _a._u8[w*4 + 3];
|
|
|
|
|
CPU.GPR[rt]._u16[w*2 + 1] = _b._u8[w*4] + _b._u8[w*4 + 1] + _b._u8[w*4 + 2] + _b._u8[w*4 + 3];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
|
|
|
|
}
|
2013-11-09 16:41:56 +01:00
|
|
|
//HGT uses signed values. HLGT uses unsigned values
|
|
|
|
|
void HGT(u32 rt, s32 ra, s32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
if (CPU.GPR[ra]._s32[3] > CPU.GPR[rb]._s32[3])
|
2014-06-23 03:03:16 +02:00
|
|
|
{
|
|
|
|
|
CPU.SPU.Status.SetValue(SPU_STATUS_STOPPED_BY_HALT);
|
|
|
|
|
CPU.Stop();
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CLZ(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
{
|
|
|
|
|
int nPos;
|
|
|
|
|
|
|
|
|
|
for (nPos = 0; nPos < 32; nPos++)
|
|
|
|
|
if (CPU.GPR[ra]._u32[w] & (1 << (31 - nPos)))
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
CPU.GPR[rt]._u32[w] = nPos;
|
|
|
|
|
}
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void XSWD(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s64[0] = (s64)CPU.GPR[ra]._s32[0];
|
|
|
|
|
CPU.GPR[rt]._s64[1] = (s64)CPU.GPR[ra]._s32[2];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void XSHW(u32 rt, u32 ra)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-06-30 10:46:29 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = (s32)CPU.GPR[ra]._s16[w*2];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CNTB(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 temp = CPU.GPR[ra];
|
|
|
|
|
CPU.GPR[rt].clear();
|
2013-06-30 10:46:29 +02:00
|
|
|
for (int b = 0; b < 16; b++)
|
|
|
|
|
for (int i = 0; i < 8; i++)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[b] += (temp._u8[b] & (1 << i)) ? 1 : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void XSBH(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s16[h] = (s16)CPU.GPR[ra]._s8[h*2];
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CLGT(u32 rt, u32 ra, u32 rb)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
for(u32 i = 0; i < 4; ++i)
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u32[i] = (CPU.GPR[ra]._u32[i] > CPU.GPR[rb]._u32[i]) ? 0xffffffff : 0x00000000;
|
|
|
|
|
}
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ANDC(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._u32[w] & (~CPU.GPR[rb]._u32[w]);
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FCGT(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = CPU.GPR[ra]._f[0] > CPU.GPR[rb]._f[0] ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[1] = CPU.GPR[ra]._f[1] > CPU.GPR[rb]._f[1] ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = CPU.GPR[ra]._f[2] > CPU.GPR[rb]._f[2] ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = CPU.GPR[ra]._f[3] > CPU.GPR[rb]._f[3] ? 0xffffffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFCGT(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
UNIMPLEMENTED(); // cannot be used
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FA(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-07-16 14:13:11 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._f[w] = CPU.GPR[ra]._f[w] + CPU.GPR[rb]._f[w];
|
|
|
|
|
//if (CPU.GPR[rt]._f[w] == -0.0f) CPU.GPR[rt]._f[w] = 0.0f;
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FS(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-07-16 14:13:11 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._f[w] = CPU.GPR[ra]._f[w] - CPU.GPR[rb]._f[w];
|
|
|
|
|
//if (CPU.GPR[rt]._f[w] == -0.0f) CPU.GPR[rt]._f[w] = 0.0f;
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FM(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-07-16 14:13:11 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._f[w] = CPU.GPR[ra]._f[w] * CPU.GPR[rb]._f[w];
|
|
|
|
|
//if (CPU.GPR[rt]._f[w] == -0.0f) CPU.GPR[rt]._f[w] = 0.0f;
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CLGTH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
|
|
|
|
CPU.GPR[rt]._u16[h] = CPU.GPR[ra]._u16[h] > CPU.GPR[rb]._u16[h] ? 0xffff : 0;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ORC(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._u32[w] | (~CPU.GPR[rb]._u32[w]);
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FCMGT(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = fabs(CPU.GPR[ra]._f[0]) > fabs(CPU.GPR[rb]._f[0]) ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[1] = fabs(CPU.GPR[ra]._f[1]) > fabs(CPU.GPR[rb]._f[1]) ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = fabs(CPU.GPR[ra]._f[2]) > fabs(CPU.GPR[rb]._f[2]) ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = fabs(CPU.GPR[ra]._f[3]) > fabs(CPU.GPR[rb]._f[3]) ? 0xffffffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFCMGT(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
UNIMPLEMENTED(); // cannot be used
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFA(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._d[0] = CPU.GPR[ra]._d[0] + CPU.GPR[rb]._d[0];
|
|
|
|
|
CPU.GPR[rt]._d[1] = CPU.GPR[ra]._d[1] + CPU.GPR[rb]._d[1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFS(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._d[0] = CPU.GPR[ra]._d[0] - CPU.GPR[rb]._d[0];
|
|
|
|
|
CPU.GPR[rt]._d[1] = CPU.GPR[ra]._d[1] - CPU.GPR[rb]._d[1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFM(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._d[0] = CPU.GPR[ra]._d[0] * CPU.GPR[rb]._d[0];
|
|
|
|
|
CPU.GPR[rt]._d[1] = CPU.GPR[ra]._d[1] * CPU.GPR[rb]._d[1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CLGTB(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
|
|
|
|
CPU.GPR[rt]._u8[b] = CPU.GPR[ra]._u8[b] > CPU.GPR[rb]._u8[b] ? 0xff : 0;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void HLGT(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-06-23 03:03:16 +02:00
|
|
|
if (CPU.GPR[ra]._u32[3] > CPU.GPR[rb]._u32[3])
|
|
|
|
|
{
|
|
|
|
|
CPU.SPU.Status.SetValue(SPU_STATUS_STOPPED_BY_HALT);
|
|
|
|
|
CPU.Stop();
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFMA(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._d[0] += CPU.GPR[ra]._d[0] * CPU.GPR[rb]._d[0];
|
|
|
|
|
CPU.GPR[rt]._d[1] += CPU.GPR[ra]._d[1] * CPU.GPR[rb]._d[1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFMS(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._d[0] = CPU.GPR[ra]._d[0] * CPU.GPR[rb]._d[0] - CPU.GPR[rt]._d[0];
|
|
|
|
|
CPU.GPR[rt]._d[1] = CPU.GPR[ra]._d[1] * CPU.GPR[rb]._d[1] - CPU.GPR[rt]._d[1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFNMS(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._d[0] -= CPU.GPR[ra]._d[0] * CPU.GPR[rb]._d[0];
|
|
|
|
|
CPU.GPR[rt]._d[1] -= CPU.GPR[ra]._d[1] * CPU.GPR[rb]._d[1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFNMA(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._d[0] = -(CPU.GPR[ra]._d[0] * CPU.GPR[rb]._d[0] + CPU.GPR[rt]._d[0]);
|
|
|
|
|
CPU.GPR[rt]._d[1] = -(CPU.GPR[ra]._d[1] * CPU.GPR[rb]._d[1] + CPU.GPR[rt]._d[1]);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CEQ(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._s32[w] == CPU.GPR[rb]._s32[w] ? 0xffffffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPYHHU(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._u16[w*2+1] * CPU.GPR[rb]._u16[w*2+1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ADDX(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._u32[w] + CPU.GPR[rb]._u32[w] + (CPU.GPR[rt]._u32[w] & 1);
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SFX(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[rb]._u32[w] - CPU.GPR[ra]._u32[w] - (1 - (CPU.GPR[rt]._u32[w] & 1));
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CGX(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
// rarely used
|
2013-06-30 10:46:29 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u32[w] = ((u64)CPU.GPR[ra]._u32[w] + (u64)CPU.GPR[rb]._u32[w] + (u64)(CPU.GPR[rt]._u32[w] & 1)) >> 32;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void BGX(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
// rarely used
|
2013-06-30 10:46:29 +02:00
|
|
|
s64 nResult;
|
|
|
|
|
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
nResult = (u64)CPU.GPR[rb]._u32[w] - (u64)CPU.GPR[ra]._u32[w] - (u64)(1 - (CPU.GPR[rt]._u32[w] & 1));
|
2013-06-30 10:46:29 +02:00
|
|
|
CPU.GPR[rt]._u32[w] = nResult < 0 ? 0 : 1;
|
|
|
|
|
}
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPYHHA(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] += CPU.GPR[ra]._s16[w*2+1] * CPU.GPR[rb]._s16[w*2+1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPYHHAU(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u32[w] += CPU.GPR[ra]._u16[w*2+1] * CPU.GPR[rb]._u16[w*2+1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-11-09 16:41:56 +01:00
|
|
|
//Forced bits to 0, hence the shift:
|
|
|
|
|
|
2013-07-04 16:20:36 +02:00
|
|
|
void FSCRRD(u32 rt)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2015-01-18 19:17:51 +01:00
|
|
|
CPU.GPR[rt]._u32[3] = CPU.FPSCR._u32[3];
|
|
|
|
|
CPU.GPR[rt]._u32[2] = CPU.FPSCR._u32[2];
|
|
|
|
|
CPU.GPR[rt]._u32[1] = CPU.FPSCR._u32[1];
|
|
|
|
|
CPU.GPR[rt]._u32[0] = CPU.FPSCR._u32[0];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FESD(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._d[0] = (double)CPU.GPR[ra]._f[1];
|
|
|
|
|
CPU.GPR[rt]._d[1] = (double)CPU.GPR[ra]._f[3];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FRDS(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._f[1] = (float)CPU.GPR[ra]._d[0];
|
|
|
|
|
CPU.GPR[rt]._u32[0] = 0x00000000;
|
|
|
|
|
CPU.GPR[rt]._f[3] = (float)CPU.GPR[ra]._d[1];
|
2014-03-01 19:11:58 +01:00
|
|
|
CPU.GPR[rt]._u32[2] = 0x00000000;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FSCRWR(u32 rt, u32 ra)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2015-01-18 19:17:51 +01:00
|
|
|
CPU.FPSCR._u32[3] = CPU.GPR[ra]._u32[3] & 0x00000F07;
|
|
|
|
|
CPU.FPSCR._u32[2] = CPU.GPR[ra]._u32[2] & 0x00003F07;
|
|
|
|
|
CPU.FPSCR._u32[1] = CPU.GPR[ra]._u32[1] & 0x00003F07;
|
|
|
|
|
CPU.FPSCR._u32[0] = CPU.GPR[ra]._u32[0] & 0x00000F07;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFTSV(u32 rt, u32 ra, s32 i7)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
UNIMPLEMENTED(); // cannot be used
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FCEQ(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = CPU.GPR[ra]._f[0] == CPU.GPR[rb]._f[0] ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[1] = CPU.GPR[ra]._f[1] == CPU.GPR[rb]._f[1] ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = CPU.GPR[ra]._f[2] == CPU.GPR[rb]._f[2] ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = CPU.GPR[ra]._f[3] == CPU.GPR[rb]._f[3] ? 0xffffffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFCEQ(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
UNIMPLEMENTED(); // cannot be used
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPY(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = CPU.GPR[ra]._s16[w*2] * CPU.GPR[rb]._s16[w*2];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPYH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = (CPU.GPR[ra]._s16[w*2+1] * CPU.GPR[rb]._s16[w*2]) << 16;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPYHH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = CPU.GPR[ra]._s16[w*2+1] * CPU.GPR[rb]._s16[w*2+1];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPYS(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = (CPU.GPR[ra]._s16[w*2] * CPU.GPR[rb]._s16[w*2]) >> 16;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CEQH(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
|
|
|
|
CPU.GPR[rt]._u16[h] = CPU.GPR[ra]._u16[h] == CPU.GPR[rb]._u16[h] ? 0xffff : 0;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FCMEQ(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-09-23 14:20:47 +02:00
|
|
|
CPU.GPR[rt]._u32[0] = fabs(CPU.GPR[ra]._f[0]) == fabs(CPU.GPR[rb]._f[0]) ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[1] = fabs(CPU.GPR[ra]._f[1]) == fabs(CPU.GPR[rb]._f[1]) ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[2] = fabs(CPU.GPR[ra]._f[2]) == fabs(CPU.GPR[rb]._f[2]) ? 0xffffffff : 0;
|
|
|
|
|
CPU.GPR[rt]._u32[3] = fabs(CPU.GPR[ra]._f[3]) == fabs(CPU.GPR[rb]._f[3]) ? 0xffffffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void DFCMEQ(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
UNIMPLEMENTED(); // cannot be used
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPYU(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2013-11-09 16:51:26 +01:00
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._u16[w*2] * CPU.GPR[rb]._u16[w*2];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CEQB(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
|
|
|
|
CPU.GPR[rt]._u8[b] = CPU.GPR[ra]._u8[b] == CPU.GPR[rb]._u8[b] ? 0xff : 0;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FI(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-08-18 02:23:05 +02:00
|
|
|
// TODO: Floating Interpolation: ra will be ignored.
|
|
|
|
|
// It should work correctly if result of preceding FREST or FRSQEST is sufficiently exact
|
2013-12-03 21:35:45 +01:00
|
|
|
CPU.GPR[rt] = CPU.GPR[rb];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void HEQ(u32 rt, u32 ra, u32 rb)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
if (CPU.GPR[ra]._s32[3] == CPU.GPR[rb]._s32[3])
|
2014-06-23 03:03:16 +02:00
|
|
|
{
|
|
|
|
|
CPU.SPU.Status.SetValue(SPU_STATUS_STOPPED_BY_HALT);
|
|
|
|
|
CPU.Stop();
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//0 - 9
|
2013-07-04 16:20:36 +02:00
|
|
|
void CFLTS(u32 rt, u32 ra, s32 i8)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-03 21:35:45 +01:00
|
|
|
const u32 scale = 173 - (i8 & 0xff); //unsigned immediate
|
|
|
|
|
for (int i = 0; i < 4; i++)
|
|
|
|
|
{
|
|
|
|
|
u32 exp = ((CPU.GPR[ra]._u32[i] >> 23) & 0xff) + scale;
|
|
|
|
|
|
|
|
|
|
if (exp > 255)
|
|
|
|
|
exp = 255;
|
|
|
|
|
|
|
|
|
|
CPU.GPR[rt]._u32[i] = (CPU.GPR[ra]._u32[i] & 0x807fffff) | (exp << 23);
|
2013-12-24 12:10:55 +01:00
|
|
|
|
2014-04-20 00:53:42 +02:00
|
|
|
if (CPU.GPR[rt]._f[i] > 0x7fffffff)
|
|
|
|
|
CPU.GPR[rt]._u32[i] = 0x7fffffff;
|
|
|
|
|
else if (CPU.GPR[rt]._f[i] < -pow(2, 31))
|
|
|
|
|
CPU.GPR[rt]._u32[i] = 0x80000000;
|
|
|
|
|
else
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[i] = (s32)CPU.GPR[rt]._f[i]; //trunc
|
2013-12-03 21:35:45 +01:00
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CFLTU(u32 rt, u32 ra, s32 i8)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-03 21:35:45 +01:00
|
|
|
const u32 scale = 173 - (i8 & 0xff); //unsigned immediate
|
|
|
|
|
for (int i = 0; i < 4; i++)
|
|
|
|
|
{
|
|
|
|
|
u32 exp = ((CPU.GPR[ra]._u32[i] >> 23) & 0xff) + scale;
|
|
|
|
|
|
|
|
|
|
if (exp > 255)
|
|
|
|
|
exp = 255;
|
|
|
|
|
|
|
|
|
|
if (CPU.GPR[ra]._u32[i] & 0x80000000) //if negative, result = 0
|
|
|
|
|
CPU.GPR[rt]._u32[i] = 0;
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u32[i] = (CPU.GPR[ra]._u32[i] & 0x807fffff) | (exp << 23);
|
|
|
|
|
|
|
|
|
|
if (CPU.GPR[rt]._f[i] > 0xffffffff) //if big, result = max
|
|
|
|
|
CPU.GPR[rt]._u32[i] = 0xffffffff;
|
|
|
|
|
else
|
2014-08-30 19:51:00 +02:00
|
|
|
CPU.GPR[rt]._u32[i] = (u32)floor(CPU.GPR[rt]._f[i]);
|
2013-12-03 21:35:45 +01:00
|
|
|
}
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CSFLT(u32 rt, u32 ra, s32 i8)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-03 21:35:45 +01:00
|
|
|
const u32 scale = 155 - (i8 & 0xff); //unsigned immediate
|
|
|
|
|
for (int i = 0; i < 4; i++)
|
|
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._f[i] = (float)CPU.GPR[ra]._s32[i];
|
2013-12-24 12:10:55 +01:00
|
|
|
|
2013-12-03 21:35:45 +01:00
|
|
|
u32 exp = ((CPU.GPR[rt]._u32[i] >> 23) & 0xff) - scale;
|
|
|
|
|
|
|
|
|
|
if (exp > 255) //< 0
|
|
|
|
|
exp = 0;
|
|
|
|
|
|
|
|
|
|
CPU.GPR[rt]._u32[i] = (CPU.GPR[rt]._u32[i] & 0x807fffff) | (exp << 23);
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CUFLT(u32 rt, u32 ra, s32 i8)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-03 21:35:45 +01:00
|
|
|
const u32 scale = 155 - (i8 & 0xff); //unsigned immediate
|
|
|
|
|
for (int i = 0; i < 4; i++)
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._f[i] = (float)CPU.GPR[ra]._u32[i];
|
2014-10-04 16:43:46 +02:00
|
|
|
|
2013-12-03 21:35:45 +01:00
|
|
|
u32 exp = ((CPU.GPR[rt]._u32[i] >> 23) & 0xff) - scale;
|
|
|
|
|
|
|
|
|
|
if (exp > 255) //< 0
|
|
|
|
|
exp = 0;
|
|
|
|
|
|
|
|
|
|
CPU.GPR[rt]._u32[i] = (CPU.GPR[rt]._u32[i] & 0x807fffff) | (exp << 23);
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
|
|
|
|
|
2012-11-15 00:39:56 +01:00
|
|
|
//0 - 8
|
2013-07-04 16:20:36 +02:00
|
|
|
void BRZ(u32 rt, s32 i16)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.PC, i16);
|
2013-12-01 01:36:55 +01:00
|
|
|
if (CPU.GPR[rt]._u32[3] == 0)
|
2014-04-07 15:06:13 +02:00
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("not taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
}
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void STQA(u32 rt, s32 i16)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
u32 lsa = (i16 << 2) & 0x3fff0;
|
2013-11-23 19:50:54 +01:00
|
|
|
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.WriteLS128(lsa, CPU.GPR[rt]);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void BRNZ(u32 rt, s32 i16)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.PC, i16);
|
2013-12-01 01:36:55 +01:00
|
|
|
if (CPU.GPR[rt]._u32[3] != 0)
|
2014-04-07 15:06:13 +02:00
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("not taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void BRHZ(u32 rt, s32 i16)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.PC, i16);
|
2014-04-07 15:06:13 +02:00
|
|
|
if (CPU.GPR[rt]._u16[6] == 0)
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("not taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
}
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void BRHNZ(u32 rt, s32 i16)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.PC, i16);
|
2014-04-07 15:06:13 +02:00
|
|
|
if (CPU.GPR[rt]._u16[6] != 0)
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("not taken (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
}
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void STQR(u32 rt, s32 i16)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-07 23:52:41 +01:00
|
|
|
u32 lsa = branchTarget(CPU.PC, i16) & 0x3fff0;
|
2013-11-23 19:50:54 +01:00
|
|
|
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.WriteLS128(lsa, CPU.GPR[rt]);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void BRA(s32 i16)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(0, i16);
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("branch (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void LQA(u32 rt, s32 i16)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
u32 lsa = (i16 << 2) & 0x3fff0;
|
2013-11-23 19:50:54 +01:00
|
|
|
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt] = CPU.ReadLS128(lsa);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void BRASL(u32 rt, s32 i16)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(0, i16);
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt].clear();
|
2014-09-15 00:17:24 +02:00
|
|
|
CPU.GPR[rt]._u32[3] = CPU.PC + 4;
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("branch (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void BR(s32 i16)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.PC, i16);
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("branch (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void FSMBI(u32 rt, s32 i16)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
const u32 s = i16;
|
|
|
|
|
|
|
|
|
|
for(u32 j = 0; j < 16; ++j)
|
|
|
|
|
{
|
|
|
|
|
if((s >> j) & 0x1)
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u8[j] = 0xFF;
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._u8[j] = 0x00;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void BRSL(u32 rt, s32 i16)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-15 00:17:24 +02:00
|
|
|
u32 target = branchTarget(CPU.PC, i16);
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt].clear();
|
2014-09-15 00:17:24 +02:00
|
|
|
CPU.GPR[rt]._u32[3] = CPU.PC + 4;
|
2014-09-15 21:04:18 +02:00
|
|
|
LOG5_OPCODE("branch (0x%x)", target);
|
2014-04-07 15:06:13 +02:00
|
|
|
CPU.SetBranch(target);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void LQR(u32 rt, s32 i16)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-07 23:52:41 +01:00
|
|
|
u32 lsa = branchTarget(CPU.PC, i16) & 0x3fff0;
|
2013-11-23 19:50:54 +01:00
|
|
|
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt] = CPU.ReadLS128(lsa);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void IL(u32 rt, s32 i16)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[0] =
|
|
|
|
|
CPU.GPR[rt]._s32[1] =
|
|
|
|
|
CPU.GPR[rt]._s32[2] =
|
|
|
|
|
CPU.GPR[rt]._s32[3] = i16;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ILHU(u32 rt, s32 i16)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = i16 << 16;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ILH(u32 rt, s32 i16)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s16[h] = i16;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void IOHL(u32 rt, s32 i16)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] |= (i16 & 0xFFFF);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
|
|
|
|
|
2012-11-15 00:39:56 +01:00
|
|
|
|
|
|
|
|
//0 - 7
|
2013-07-04 16:20:36 +02:00
|
|
|
void ORI(u32 rt, u32 ra, s32 i10)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
for(u32 i = 0; i < 4; ++i)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[i] = CPU.GPR[ra]._s32[i] | i10;
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ORHI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s16[h] = CPU.GPR[ra]._s16[h] | i10;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ORBI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s8[b] = CPU.GPR[ra]._s8[b] | i10;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SFI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = i10 - CPU.GPR[ra]._s32[w];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void SFHI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s16[h] = i10 - CPU.GPR[ra]._s16[h];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ANDI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = CPU.GPR[ra]._s32[w] & i10;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ANDHI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s16[h] = CPU.GPR[ra]._s16[h] & i10;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void ANDBI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s8[b] = CPU.GPR[ra]._s8[b] & i10;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void AI(u32 rt, u32 ra, s32 i10)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[0] = CPU.GPR[ra]._s32[0] + i10;
|
|
|
|
|
CPU.GPR[rt]._s32[1] = CPU.GPR[ra]._s32[1] + i10;
|
|
|
|
|
CPU.GPR[rt]._s32[2] = CPU.GPR[ra]._s32[2] + i10;
|
|
|
|
|
CPU.GPR[rt]._s32[3] = CPU.GPR[ra]._s32[3] + i10;
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void AHI(u32 rt, u32 ra, s32 i10)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
for(u32 h = 0; h < 8; ++h)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s16[h] = CPU.GPR[ra]._s16[h] + i10;
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-12-01 18:30:40 +01:00
|
|
|
void STQD(u32 rt, s32 i10, u32 ra) //i10 is shifted left by 4 while decoding
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u32 lsa = (CPU.GPR[ra]._s32[3] + i10) & 0x3fff0;
|
2014-08-05 12:18:22 +02:00
|
|
|
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.WriteLS128(lsa, CPU.GPR[rt]);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-12-01 18:30:40 +01:00
|
|
|
void LQD(u32 rt, s32 i10, u32 ra) //i10 is shifted left by 4 while decoding
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u32 lsa = (CPU.GPR[ra]._s32[3] + i10) & 0x3fff0;
|
2013-11-23 19:50:54 +01:00
|
|
|
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt] = CPU.ReadLS128(lsa);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void XORI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = CPU.GPR[ra]._s32[w] ^ i10;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void XORHI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s16[h] = CPU.GPR[ra]._s16[h] ^ i10;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void XORBI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s8[b] = CPU.GPR[ra]._s8[b] ^ i10;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CGTI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._s32[w] > i10 ? 0xffffffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CGTHI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._u16[h] = CPU.GPR[ra]._s16[h] > i10 ? 0xffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CGTBI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._u8[b] = CPU.GPR[ra]._s8[b] > (s8)(i10 & 0xff) ? 0xff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void HGTI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
if (CPU.GPR[ra]._s32[3] > i10)
|
2014-06-23 03:03:16 +02:00
|
|
|
{
|
|
|
|
|
CPU.SPU.Status.SetValue(SPU_STATUS_STOPPED_BY_HALT);
|
|
|
|
|
CPU.Stop();
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CLGTI(u32 rt, u32 ra, s32 i10)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
for(u32 i = 0; i < 4; ++i)
|
|
|
|
|
{
|
2013-11-30 00:40:31 +01:00
|
|
|
CPU.GPR[rt]._u32[i] = (CPU.GPR[ra]._u32[i] > (u32)i10) ? 0xffffffff : 0x00000000;
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CLGTHI(u32 rt, u32 ra, s32 i10)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
for(u32 i = 0; i < 8; ++i)
|
|
|
|
|
{
|
2013-11-30 00:40:31 +01:00
|
|
|
CPU.GPR[rt]._u16[i] = (CPU.GPR[ra]._u16[i] > (u16)i10) ? 0xffff : 0x0000;
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CLGTBI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
|
|
|
|
CPU.GPR[rt]._u8[b] = CPU.GPR[ra]._u8[b] > (u8)(i10 & 0xff) ? 0xff : 0;
|
|
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void HLGTI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-06-23 03:03:16 +02:00
|
|
|
if (CPU.GPR[ra]._u32[3] > (u32)i10)
|
|
|
|
|
{
|
|
|
|
|
CPU.SPU.Status.SetValue(SPU_STATUS_STOPPED_BY_HALT);
|
|
|
|
|
CPU.Stop();
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPYI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = CPU.GPR[ra]._s16[w*2] * i10;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void MPYUI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u32[w] = CPU.GPR[ra]._u16[w*2] * (u16)(i10 & 0xffff);
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CEQI(u32 rt, u32 ra, s32 i10)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
for(u32 i = 0; i < 4; ++i)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._u32[i] = (CPU.GPR[ra]._s32[i] == i10) ? 0xffffffff : 0x00000000;
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CEQHI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int h = 0; h < 8; h++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._u16[h] = (CPU.GPR[ra]._s16[h] == (s16)i10) ? 0xffff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void CEQBI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int b = 0; b < 16; b++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s8[b] = (CPU.GPR[ra]._s8[b] == (s8)(i10 & 0xff)) ? 0xff : 0;
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void HEQI(u32 rt, u32 ra, s32 i10)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
if (CPU.GPR[ra]._s32[3] == i10)
|
2014-06-23 03:03:16 +02:00
|
|
|
{
|
|
|
|
|
CPU.SPU.Status.SetValue(SPU_STATUS_STOPPED_BY_HALT);
|
|
|
|
|
CPU.Stop();
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
|
|
|
|
|
2012-11-15 00:39:56 +01:00
|
|
|
|
|
|
|
|
//0 - 6
|
2013-07-04 16:20:36 +02:00
|
|
|
void HBRA(s32 ro, s32 i16)
|
2013-12-01 18:30:40 +01:00
|
|
|
{ //i16 is shifted left by 2 while decoding
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-07-04 16:20:36 +02:00
|
|
|
void HBRR(s32 ro, s32 i16)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
|
|
|
|
}
|
2013-12-07 23:52:41 +01:00
|
|
|
void ILA(u32 rt, u32 i18)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-01 01:36:55 +01:00
|
|
|
CPU.GPR[rt]._u32[0] =
|
|
|
|
|
CPU.GPR[rt]._u32[1] =
|
|
|
|
|
CPU.GPR[rt]._u32[2] =
|
|
|
|
|
CPU.GPR[rt]._u32[3] = i18 & 0x3FFFF;
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//0 - 3
|
2013-07-04 16:20:36 +02:00
|
|
|
void SELB(u32 rt, u32 ra, u32 rb, u32 rc)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
for(u64 i = 0; i < 2; ++i)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u64[i] =
|
|
|
|
|
( CPU.GPR[rc]._u64[i] & CPU.GPR[rb]._u64[i]) |
|
|
|
|
|
(~CPU.GPR[rc]._u64[i] & CPU.GPR[ra]._u64[i]);
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
|
|
|
|
}
|
2013-08-03 11:40:03 +02:00
|
|
|
void SHUFB(u32 rt, u32 ra, u32 rb, u32 rc)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-06 18:30:13 +02:00
|
|
|
const u128 _a = CPU.GPR[ra];
|
|
|
|
|
const u128 _b = CPU.GPR[rb];
|
2013-11-30 00:40:31 +01:00
|
|
|
for (int i = 0; i < 16; i++)
|
|
|
|
|
{
|
|
|
|
|
u8 b = CPU.GPR[rc]._u8[i];
|
2013-12-07 23:52:41 +01:00
|
|
|
if(b & 0x80)
|
|
|
|
|
{
|
|
|
|
|
if(b & 0x40)
|
|
|
|
|
{
|
2013-11-30 00:40:31 +01:00
|
|
|
if(b & 0x20)
|
|
|
|
|
CPU.GPR[rt]._u8[i] = 0x80;
|
|
|
|
|
else
|
|
|
|
|
CPU.GPR[rt]._u8[i] = 0xFF;
|
2013-12-07 23:52:41 +01:00
|
|
|
}
|
|
|
|
|
else
|
2013-11-30 00:40:31 +01:00
|
|
|
CPU.GPR[rt]._u8[i] = 0x00;
|
2013-12-07 23:52:41 +01:00
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
2013-11-30 00:40:31 +01:00
|
|
|
if(b & 0x10)
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[i] = _b._u8[15 - (b & 0x0F)];
|
2013-11-30 00:40:31 +01:00
|
|
|
else
|
2013-12-01 18:30:40 +01:00
|
|
|
CPU.GPR[rt]._u8[i] = _a._u8[15 - (b & 0x0F)];
|
2013-11-30 00:40:31 +01:00
|
|
|
}
|
|
|
|
|
}
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
2013-12-23 12:57:09 +01:00
|
|
|
void MPYA(u32 rt, u32 ra, u32 rb, u32 rc)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
|
|
|
|
for (int w = 0; w < 4; w++)
|
2014-09-06 18:30:13 +02:00
|
|
|
CPU.GPR[rt]._s32[w] = CPU.GPR[ra]._s16[w*2] * CPU.GPR[rb]._s16[w*2] + CPU.GPR[rc]._s32[w];
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-08-03 11:40:03 +02:00
|
|
|
void FNMS(u32 rt, u32 ra, u32 rb, u32 rc)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-07-16 14:13:11 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._f[w] = CPU.GPR[rc]._f[w] - CPU.GPR[ra]._f[w] * CPU.GPR[rb]._f[w];
|
|
|
|
|
//if (CPU.GPR[rt]._f[w] == -0.0f) CPU.GPR[rt]._f[w] = 0.0f;
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-12-23 12:57:09 +01:00
|
|
|
void FMA(u32 rt, u32 ra, u32 rb, u32 rc)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-07-16 14:13:11 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._f[w] = CPU.GPR[rc]._f[w] + CPU.GPR[ra]._f[w] * CPU.GPR[rb]._f[w];
|
|
|
|
|
//if (CPU.GPR[rt]._f[w] == -0.0f) CPU.GPR[rt]._f[w] = 0.0f;
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2013-12-23 12:57:09 +01:00
|
|
|
void FMS(u32 rt, u32 ra, u32 rb, u32 rc)
|
2013-06-30 10:46:29 +02:00
|
|
|
{
|
2014-07-16 14:13:11 +02:00
|
|
|
for (int w = 0; w < 4; w++)
|
|
|
|
|
{
|
|
|
|
|
CPU.GPR[rt]._f[w] = CPU.GPR[ra]._f[w] * CPU.GPR[rb]._f[w] - CPU.GPR[rc]._f[w];
|
|
|
|
|
//if (CPU.GPR[rt]._f[w] == -0.0f) CPU.GPR[rt]._f[w] = 0.0f;
|
|
|
|
|
}
|
2013-06-30 10:46:29 +02:00
|
|
|
}
|
2012-11-15 00:39:56 +01:00
|
|
|
|
2013-07-04 16:20:36 +02:00
|
|
|
void UNK(u32 code, u32 opcode, u32 gcode)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-04-01 02:33:55 +02:00
|
|
|
UNK(fmt::Format("Unknown/Illegal opcode! (0x%08x, 0x%x, 0x%x)", code, opcode, gcode));
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
|
|
|
|
|
2014-04-01 02:33:55 +02:00
|
|
|
void UNK(const std::string& err)
|
2012-11-15 00:39:56 +01:00
|
|
|
{
|
2014-09-17 15:15:17 +02:00
|
|
|
LOG_ERROR(Log::SPU, "%s #pc: 0x%x", err.c_str(), CPU.PC);
|
2012-11-15 00:39:56 +01:00
|
|
|
Emu.Pause();
|
2014-09-06 18:30:13 +02:00
|
|
|
for(uint i=0; i<128; ++i) LOG_NOTICE(Log::SPU, "r%d = 0x%s", i, CPU.GPR[i].to_hex().c_str());
|
2012-11-15 00:39:56 +01:00
|
|
|
}
|
|
|
|
|
};
|