mirror of
https://github.com/simple64/simple64.git
synced 2026-11-13 02:08:42 +01:00
68 lines
1.3 KiB
C++
68 lines
1.3 KiB
C++
#include "../state.hpp"
|
|
|
|
extern "C"
|
|
{
|
|
|
|
void RSP_CFC2(RSP::CPUState *rsp, unsigned rt, unsigned rd)
|
|
{
|
|
unsigned src = rd & 3;
|
|
if (src == 3)
|
|
src = 2;
|
|
|
|
int16_t res = rsp_get_flags(rsp->cp2.flags[src].e);
|
|
if (rt)
|
|
rsp->sr[rt] = res;
|
|
}
|
|
|
|
void RSP_CTC2(RSP::CPUState *rsp, unsigned rt, unsigned rd)
|
|
{
|
|
rt = rsp->sr[rt] & 0xffff;
|
|
|
|
unsigned dst = rd & 3;
|
|
if (dst >= 2)
|
|
{
|
|
rt &= 0xff;
|
|
dst = 2;
|
|
}
|
|
rsp_set_flags(rsp->cp2.flags[dst].e, rt);
|
|
}
|
|
|
|
void RSP_MTC2(RSP::CPUState *rsp, unsigned rt, unsigned rd, unsigned element)
|
|
{
|
|
#ifdef INTENSE_DEBUG
|
|
fprintf(stderr, "MTC2, rt = %u, [rt] = 0x%x, rd = %u, e = %u\n", rt, rsp->sr[rt], rd, element);
|
|
#endif
|
|
|
|
uint16_t *e = rsp->cp2.regs[rd].e;
|
|
const uint16_t v = rsp->sr[rt];
|
|
if (element & 1)
|
|
{
|
|
const auto i = element >> 1;
|
|
e[i] = (e[i] & 0xff00) | (v >> 8);
|
|
if (element != 0xf)
|
|
e[i+1] = (e[i+1] & 0xff) | (v << 8);
|
|
}
|
|
else
|
|
e[element >> 1] = v;
|
|
}
|
|
|
|
void RSP_MFC2(RSP::CPUState *rsp, unsigned rt, unsigned rd, unsigned element)
|
|
{
|
|
if (rt == 0)
|
|
return;
|
|
|
|
const uint16_t *e = rsp->cp2.regs[rd].e;
|
|
unsigned lo = element >> 1;
|
|
|
|
if (element & 1)
|
|
{
|
|
unsigned hi = ((element + 1) >> 1) & 7;
|
|
uint16_t high = e[lo] << 8;
|
|
uint8_t low = e[hi] >> 8;
|
|
rsp->sr[rt] = int16_t(high | low);
|
|
}
|
|
else
|
|
rsp->sr[rt] = int16_t(e[lo]);
|
|
}
|
|
}
|