This commit is contained in:
OBattler
2023-07-16 03:22:04 +02:00
parent 8b4a2a6ecc
commit dd38a5a15f

View File

@@ -36,17 +36,20 @@ static int
opPAVGUSB(uint32_t fetchdat) opPAVGUSB(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].b[0] = (cpu_state.MM[cpu_reg].b[0] + src.b[0] + 1) >> 1; dst->b[0] = (dst->b[0] + src.b[0] + 1) >> 1;
cpu_state.MM[cpu_reg].b[1] = (cpu_state.MM[cpu_reg].b[1] + src.b[1] + 1) >> 1; dst->b[1] = (dst->b[1] + src.b[1] + 1) >> 1;
cpu_state.MM[cpu_reg].b[2] = (cpu_state.MM[cpu_reg].b[2] + src.b[2] + 1) >> 1; dst->b[2] = (dst->b[2] + src.b[2] + 1) >> 1;
cpu_state.MM[cpu_reg].b[3] = (cpu_state.MM[cpu_reg].b[3] + src.b[3] + 1) >> 1; dst->b[3] = (dst->b[3] + src.b[3] + 1) >> 1;
cpu_state.MM[cpu_reg].b[4] = (cpu_state.MM[cpu_reg].b[4] + src.b[4] + 1) >> 1; dst->b[4] = (dst->b[4] + src.b[4] + 1) >> 1;
cpu_state.MM[cpu_reg].b[5] = (cpu_state.MM[cpu_reg].b[5] + src.b[5] + 1) >> 1; dst->b[5] = (dst->b[5] + src.b[5] + 1) >> 1;
cpu_state.MM[cpu_reg].b[6] = (cpu_state.MM[cpu_reg].b[6] + src.b[6] + 1) >> 1; dst->b[6] = (dst->b[6] + src.b[6] + 1) >> 1;
cpu_state.MM[cpu_reg].b[7] = (cpu_state.MM[cpu_reg].b[7] + src.b[7] + 1) >> 1; dst->b[7] = (dst->b[7] + src.b[7] + 1) >> 1;
MMX_SETEXP();
return 0; return 0;
} }
@@ -54,11 +57,14 @@ static int
opPF2ID(uint32_t fetchdat) opPF2ID(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].sl[0] = (int32_t) src.f[0]; dst->sl[0] = (int32_t) src.f[0];
cpu_state.MM[cpu_reg].sl[1] = (int32_t) src.f[1]; dst->sl[1] = (int32_t) src.f[1];
MMX_SETEXP();
return 0; return 0;
} }
@@ -66,11 +72,14 @@ static int
opPF2IW(uint32_t fetchdat) opPF2IW(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].sw[0] = (int32_t) src.f[0]; dst->sw[0] = (int32_t) src.f[0];
cpu_state.MM[cpu_reg].sw[1] = (int32_t) src.f[1]; dst->sw[1] = (int32_t) src.f[1];
MMX_SETEXP();
return 0; return 0;
} }
@@ -78,13 +87,16 @@ static int
opPFACC(uint32_t fetchdat) opPFACC(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
float tempf; float tempf;
MMX_GETSRC(); MMX_GETSRC();
tempf = cpu_state.MM[cpu_reg].f[0] + cpu_state.MM[cpu_reg].f[1]; tempf = dst->f[0] + dst->f[1];
cpu_state.MM[cpu_reg].f[1] = src.f[0] + src.f[1]; dst->f[1] = src.f[0] + src.f[1];
cpu_state.MM[cpu_reg].f[0] = tempf; dst->f[0] = tempf;
MMX_SETEXP();
return 0; return 0;
} }
@@ -92,13 +104,16 @@ static int
opPFNACC(uint32_t fetchdat) opPFNACC(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
float tempf; float tempf;
MMX_GETSRC(); MMX_GETSRC();
tempf = cpu_state.MM[cpu_reg].f[0] - cpu_state.MM[cpu_reg].f[1]; tempf = dst->f[0] - dst->f[1];
cpu_state.MM[cpu_reg].f[1] = src.f[0] - src.f[1]; dst->f[1] = src.f[0] - src.f[1];
cpu_state.MM[cpu_reg].f[0] = tempf; dst->f[0] = tempf;
MMX_SETEXP();
return 0; return 0;
} }
@@ -106,13 +121,16 @@ static int
opPFPNACC(uint32_t fetchdat) opPFPNACC(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
float tempf; float tempf;
MMX_GETSRC(); MMX_GETSRC();
tempf = cpu_state.MM[cpu_reg].f[0] - cpu_state.MM[cpu_reg].f[1]; tempf = dst->f[0] - dst->f[1];
cpu_state.MM[cpu_reg].f[1] = src.f[0] + src.f[1]; dst->f[1] = src.f[0] + src.f[1];
cpu_state.MM[cpu_reg].f[0] = tempf; dst->f[0] = tempf;
MMX_SETEXP();
return 0; return 0;
} }
@@ -120,15 +138,18 @@ static int
opPSWAPD(uint32_t fetchdat) opPSWAPD(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
float tempf, tempf2; float tempf, tempf2;
MMX_GETSRC(); MMX_GETSRC();
/* We have to do this in case source and destination overlap. */ /* We have to do this in case source and destination overlap. */
tempf = src.f[0]; tempf = src.f[0];
tempf2 = src.f[1]; tempf2 = src.f[1];
cpu_state.MM[cpu_reg].f[1] = tempf; dst->f[1] = tempf;
cpu_state.MM[cpu_reg].f[0] = tempf2; dst->f[0] = tempf2;
MMX_SETEXP();
return 0; return 0;
} }
@@ -136,11 +157,14 @@ static int
opPFADD(uint32_t fetchdat) opPFADD(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].f[0] += src.f[0]; dst->f[0] += src.f[0];
cpu_state.MM[cpu_reg].f[1] += src.f[1]; dst->f[1] += src.f[1];
MMX_SETEXP();
return 0; return 0;
} }
@@ -148,11 +172,14 @@ static int
opPFCMPEQ(uint32_t fetchdat) opPFCMPEQ(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].l[0] = (cpu_state.MM[cpu_reg].f[0] == src.f[0]) ? 0xffffffff : 0; dst->l[0] = (dst->f[0] == src.f[0]) ? 0xffffffff : 0;
cpu_state.MM[cpu_reg].l[1] = (cpu_state.MM[cpu_reg].f[1] == src.f[1]) ? 0xffffffff : 0; dst->l[1] = (dst->f[1] == src.f[1]) ? 0xffffffff : 0;
MMX_SETEXP();
return 0; return 0;
} }
@@ -160,11 +187,14 @@ static int
opPFCMPGE(uint32_t fetchdat) opPFCMPGE(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].l[0] = (cpu_state.MM[cpu_reg].f[0] >= src.f[0]) ? 0xffffffff : 0; dst->l[0] = (dst->f[0] >= src.f[0]) ? 0xffffffff : 0;
cpu_state.MM[cpu_reg].l[1] = (cpu_state.MM[cpu_reg].f[1] >= src.f[1]) ? 0xffffffff : 0; dst->l[1] = (dst->f[1] >= src.f[1]) ? 0xffffffff : 0;
MMX_SETEXP();
return 0; return 0;
} }
@@ -172,11 +202,14 @@ static int
opPFCMPGT(uint32_t fetchdat) opPFCMPGT(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].l[0] = (cpu_state.MM[cpu_reg].f[0] > src.f[0]) ? 0xffffffff : 0; dst->l[0] = (dst->f[0] > src.f[0]) ? 0xffffffff : 0;
cpu_state.MM[cpu_reg].l[1] = (cpu_state.MM[cpu_reg].f[1] > src.f[1]) ? 0xffffffff : 0; dst->l[1] = (dst->f[1] > src.f[1]) ? 0xffffffff : 0;
MMX_SETEXP();
return 0; return 0;
} }
@@ -184,13 +217,16 @@ static int
opPFMAX(uint32_t fetchdat) opPFMAX(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
if (src.f[0] > cpu_state.MM[cpu_reg].f[0]) if (src.f[0] > dst->f[0])
cpu_state.MM[cpu_reg].f[0] = src.f[0]; dst->f[0] = src.f[0];
if (src.f[1] > cpu_state.MM[cpu_reg].f[1]) if (src.f[1] > dst->f[1])
cpu_state.MM[cpu_reg].f[1] = src.f[1]; dst->f[1] = src.f[1];
MMX_SETEXP();
return 0; return 0;
} }
@@ -198,13 +234,16 @@ static int
opPFMIN(uint32_t fetchdat) opPFMIN(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
if (src.f[0] < cpu_state.MM[cpu_reg].f[0]) if (src.f[0] < dst->f[0])
cpu_state.MM[cpu_reg].f[0] = src.f[0]; dst->f[0] = src.f[0];
if (src.f[1] < cpu_state.MM[cpu_reg].f[1]) if (src.f[1] < dst->f[1])
cpu_state.MM[cpu_reg].f[1] = src.f[1]; dst->f[1] = src.f[1];
MMX_SETEXP();
return 0; return 0;
} }
@@ -212,24 +251,29 @@ static int
opPFMUL(uint32_t fetchdat) opPFMUL(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].f[0] *= src.f[0]; dst->f[0] *= src.f[0];
cpu_state.MM[cpu_reg].f[1] *= src.f[1]; dst->f[1] *= src.f[1];
MMX_SETEXP();
return 0; return 0;
} }
static int static int
opPFRCP(uint32_t fetchdat) opPFRCP(uint32_t fetchdat)
{ {
MMX_REG *dst = MMX_GETREGP(cpu_reg);
union { union {
uint32_t i; uint32_t i;
float f; float f;
} src; } src;
if (cpu_mod == 3) { if (cpu_mod == 3) {
src.f = cpu_state.MM[cpu_rm].f[0]; src.f = (MMX_GETREG(cpu_rm)).f[0];
CLOCK_CYCLES(1); CLOCK_CYCLES(1);
} else { } else {
SEG_CHECK_READ(cpu_state.ea_seg); SEG_CHECK_READ(cpu_state.ea_seg);
@@ -239,8 +283,10 @@ opPFRCP(uint32_t fetchdat)
CLOCK_CYCLES(2); CLOCK_CYCLES(2);
} }
cpu_state.MM[cpu_reg].f[0] = 1.0 / src.f; dst->f[0] = 1.0 / src.f;
cpu_state.MM[cpu_reg].f[1] = cpu_state.MM[cpu_reg].f[0]; dst->f[1] = dst->f[0];
MMX_SETEXP();
return 0; return 0;
} }
@@ -249,11 +295,14 @@ static int
opPFRCPIT1(uint32_t fetchdat) opPFRCPIT1(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].f[0] = src.f[0]; dst->f[0] = src.f[0];
cpu_state.MM[cpu_reg].f[1] = src.f[1]; dst->f[1] = src.f[1];
MMX_SETEXP();
return 0; return 0;
} }
@@ -261,24 +310,29 @@ static int
opPFRCPIT2(uint32_t fetchdat) opPFRCPIT2(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].f[0] = src.f[0]; dst->f[0] = src.f[0];
cpu_state.MM[cpu_reg].f[1] = src.f[1]; dst->f[1] = src.f[1];
MMX_SETEXP();
return 0; return 0;
} }
static int static int
opPFRSQRT(uint32_t fetchdat) opPFRSQRT(uint32_t fetchdat)
{ {
MMX_REG *dst = MMX_GETREGP(cpu_reg);
union { union {
uint32_t i; uint32_t i;
float f; float f;
} src; } src;
if (cpu_mod == 3) { if (cpu_mod == 3) {
src.f = cpu_state.MM[cpu_rm].f[0]; src.f = (MMX_GETREG(cpu_rm)).f[0];
CLOCK_CYCLES(1); CLOCK_CYCLES(1);
} else { } else {
SEG_CHECK_READ(cpu_state.ea_seg); SEG_CHECK_READ(cpu_state.ea_seg);
@@ -288,8 +342,10 @@ opPFRSQRT(uint32_t fetchdat)
CLOCK_CYCLES(2); CLOCK_CYCLES(2);
} }
cpu_state.MM[cpu_reg].f[0] = 1.0 / sqrt(src.f); dst->f[0] = 1.0 / sqrt(src.f);
cpu_state.MM[cpu_reg].f[1] = cpu_state.MM[cpu_reg].f[0]; dst->f[1] = dst->f[0];
MMX_SETEXP();
return 0; return 0;
} }
@@ -308,11 +364,14 @@ static int
opPFSUB(uint32_t fetchdat) opPFSUB(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].f[0] -= src.f[0]; dst->f[0] -= src.f[0];
cpu_state.MM[cpu_reg].f[1] -= src.f[1]; dst->f[1] -= src.f[1];
MMX_SETEXP();
return 0; return 0;
} }
@@ -320,11 +379,14 @@ static int
opPFSUBR(uint32_t fetchdat) opPFSUBR(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].f[0] = src.f[0] - cpu_state.MM[cpu_reg].f[0]; dst->f[0] = src.f[0] - dst->f[0];
cpu_state.MM[cpu_reg].f[1] = src.f[1] - cpu_state.MM[cpu_reg].f[1]; dst->f[1] = src.f[1] - dst->f[1];
MMX_SETEXP();
return 0; return 0;
} }
@@ -332,11 +394,14 @@ static int
opPI2FD(uint32_t fetchdat) opPI2FD(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].f[0] = (float) src.sl[0]; dst->f[0] = (float) src.sl[0];
cpu_state.MM[cpu_reg].f[1] = (float) src.sl[1]; dst->f[1] = (float) src.sl[1];
MMX_SETEXP();
return 0; return 0;
} }
@@ -344,37 +409,46 @@ static int
opPI2FW(uint32_t fetchdat) opPI2FW(uint32_t fetchdat)
{ {
MMX_REG src; MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
MMX_GETSRC(); MMX_GETSRC();
cpu_state.MM[cpu_reg].f[0] = (float) src.sw[0]; dst->f[0] = (float) src.sw[0];
cpu_state.MM[cpu_reg].f[1] = (float) src.sw[1]; dst->f[1] = (float) src.sw[1];
MMX_SETEXP();
return 0; return 0;
} }
static int static int
opPMULHRW(uint32_t fetchdat) opPMULHRW(uint32_t fetchdat)
{ {
MMX_REG src;
MMX_REG *dst = MMX_GETREGP(cpu_reg);
if (cpu_mod == 3) { if (cpu_mod == 3) {
cpu_state.MM[cpu_reg].w[0] = (((int32_t) cpu_state.MM[cpu_reg].sw[0] * (int32_t) cpu_state.MM[cpu_rm].sw[0]) + 0x8000) >> 16; src = MMX_GETREG(cpu_rm);
cpu_state.MM[cpu_reg].w[1] = (((int32_t) cpu_state.MM[cpu_reg].sw[1] * (int32_t) cpu_state.MM[cpu_rm].sw[1]) + 0x8000) >> 16;
cpu_state.MM[cpu_reg].w[2] = (((int32_t) cpu_state.MM[cpu_reg].sw[2] * (int32_t) cpu_state.MM[cpu_rm].sw[2]) + 0x8000) >> 16; dst->w[0] = (((int32_t) dst->sw[0] * (int32_t) src.sw[0]) + 0x8000) >> 16;
cpu_state.MM[cpu_reg].w[3] = (((int32_t) cpu_state.MM[cpu_reg].sw[3] * (int32_t) cpu_state.MM[cpu_rm].sw[3]) + 0x8000) >> 16; dst->w[1] = (((int32_t) dst->sw[1] * (int32_t) src.sw[1]) + 0x8000) >> 16;
dst->w[2] = (((int32_t) dst->sw[2] * (int32_t) src.sw[2]) + 0x8000) >> 16;
dst->w[3] = (((int32_t) dst->sw[3] * (int32_t) src.sw[3]) + 0x8000) >> 16;
CLOCK_CYCLES(1); CLOCK_CYCLES(1);
} else { } else {
MMX_REG src;
SEG_CHECK_READ(cpu_state.ea_seg); SEG_CHECK_READ(cpu_state.ea_seg);
src.l[0] = readmeml(easeg, cpu_state.eaaddr); src.l[0] = readmeml(easeg, cpu_state.eaaddr);
src.l[1] = readmeml(easeg, cpu_state.eaaddr + 4); src.l[1] = readmeml(easeg, cpu_state.eaaddr + 4);
if (cpu_state.abrt) if (cpu_state.abrt)
return 0; return 0;
cpu_state.MM[cpu_reg].w[0] = ((int32_t) (cpu_state.MM[cpu_reg].sw[0] * (int32_t) src.sw[0]) + 0x8000) >> 16; dst->w[0] = ((int32_t) (dst->sw[0] * (int32_t) src.sw[0]) + 0x8000) >> 16;
cpu_state.MM[cpu_reg].w[1] = ((int32_t) (cpu_state.MM[cpu_reg].sw[1] * (int32_t) src.sw[1]) + 0x8000) >> 16; dst->w[1] = ((int32_t) (dst->sw[1] * (int32_t) src.sw[1]) + 0x8000) >> 16;
cpu_state.MM[cpu_reg].w[2] = ((int32_t) (cpu_state.MM[cpu_reg].sw[2] * (int32_t) src.sw[2]) + 0x8000) >> 16; dst->w[2] = ((int32_t) (dst->sw[2] * (int32_t) src.sw[2]) + 0x8000) >> 16;
cpu_state.MM[cpu_reg].w[3] = ((int32_t) (cpu_state.MM[cpu_reg].sw[3] * (int32_t) src.sw[3]) + 0x8000) >> 16; dst->w[3] = ((int32_t) (dst->sw[3] * (int32_t) src.sw[3]) + 0x8000) >> 16;
CLOCK_CYCLES(2); CLOCK_CYCLES(2);
} }
MMX_SETEXP();
return 0; return 0;
} }