1105 lines
27 KiB
C
1105 lines
27 KiB
C
/*-*- mode:c;indent-tabs-mode:nil;c-basic-offset:2;tab-width:8;coding:utf-8 -*-│
|
|
│vi: set net ft=c ts=2 sts=2 sw=2 fenc=utf-8 :vi│
|
|
╞══════════════════════════════════════════════════════════════════════════════╡
|
|
│ Copyright 2020 Justine Alexandra Roberts Tunney │
|
|
│ │
|
|
│ This program is free software; you can redistribute it and/or modify │
|
|
│ it under the terms of the GNU General Public License as published by │
|
|
│ the Free Software Foundation; version 2 of the License. │
|
|
│ │
|
|
│ This program is distributed in the hope that it will be useful, but │
|
|
│ WITHOUT ANY WARRANTY; without even the implied warranty of │
|
|
│ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU │
|
|
│ General Public License for more details. │
|
|
│ │
|
|
│ You should have received a copy of the GNU General Public License │
|
|
│ along with this program; if not, write to the Free Software │
|
|
│ Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA │
|
|
│ 02110-1301 USA │
|
|
╚─────────────────────────────────────────────────────────────────────────────*/
|
|
#include "ape/config.h"
|
|
#include "ape/lib/pc.h"
|
|
#include "libc/math.h"
|
|
#include "libc/runtime/runtime.h"
|
|
#include "libc/str/str.h"
|
|
#include "tool/build/lib/case.h"
|
|
#include "tool/build/lib/endian.h"
|
|
#include "tool/build/lib/flags.h"
|
|
#include "tool/build/lib/fpu.h"
|
|
#include "tool/build/lib/machine.h"
|
|
#include "tool/build/lib/memory.h"
|
|
#include "tool/build/lib/modrm.h"
|
|
#include "tool/build/lib/throw.h"
|
|
#include "tool/build/lib/x87.h"
|
|
|
|
#define FPUREG 0
|
|
#define MEMORY 1
|
|
|
|
#define DISP(x, y, z) (((x)&0b111) << 4 | (y) << 3 | (z))
|
|
|
|
static void OnFpuStackOverflow(struct Machine *m) {
|
|
m->fpu.ie = true;
|
|
m->fpu.c1 = true;
|
|
m->fpu.sf = true;
|
|
}
|
|
|
|
static long double OnFpuStackUnderflow(struct Machine *m) {
|
|
m->fpu.ie = true;
|
|
m->fpu.c1 = false;
|
|
m->fpu.sf = true;
|
|
return -NAN;
|
|
}
|
|
|
|
static long double St(struct Machine *m, int i) {
|
|
if (FpuGetTag(m, i) == kFpuTagEmpty) OnFpuStackUnderflow(m);
|
|
return *FpuSt(m, i);
|
|
}
|
|
|
|
static long double St0(struct Machine *m) {
|
|
return St(m, 0);
|
|
}
|
|
|
|
static long double St1(struct Machine *m) {
|
|
return St(m, 1);
|
|
}
|
|
|
|
static long double StRm(struct Machine *m) {
|
|
return St(m, ModrmRm(m->xedd->op.rde));
|
|
}
|
|
|
|
static void FpuClearRoundup(struct Machine *m) {
|
|
m->fpu.c1 = false;
|
|
}
|
|
|
|
static void FpuClearOutOfRangeIndicator(struct Machine *m) {
|
|
m->fpu.c2 = false;
|
|
}
|
|
|
|
static void FpuSetSt0(struct Machine *m, long double x) {
|
|
*FpuSt(m, 0) = x;
|
|
}
|
|
|
|
static void FpuSetStRm(struct Machine *m, long double x) {
|
|
*FpuSt(m, ModrmRm(m->xedd->op.rde)) = x;
|
|
}
|
|
|
|
static void FpuSetStPop(struct Machine *m, int i, long double x) {
|
|
*FpuSt(m, i) = x;
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void FpuSetStRmPop(struct Machine *m, long double x) {
|
|
FpuSetStPop(m, ModrmRm(m->xedd->op.rde), x);
|
|
}
|
|
|
|
static int16_t GetMemoryShort(struct Machine *m) {
|
|
uint8_t b[2];
|
|
return Read16(Load(m, m->fpu.dp, 2, b));
|
|
}
|
|
|
|
static int32_t GetMemoryInt(struct Machine *m) {
|
|
uint8_t b[4];
|
|
return Read32(Load(m, m->fpu.dp, 4, b));
|
|
}
|
|
|
|
static int64_t GetMemoryLong(struct Machine *m) {
|
|
uint8_t b[8];
|
|
return Read64(Load(m, m->fpu.dp, 8, b));
|
|
}
|
|
|
|
static float GetMemoryFloat(struct Machine *m) {
|
|
float f;
|
|
uint8_t b[4];
|
|
memcpy(&f, Load(m, m->fpu.dp, 4, b), 4);
|
|
return f;
|
|
}
|
|
|
|
static double GetMemoryDouble(struct Machine *m) {
|
|
double f;
|
|
uint8_t b[8];
|
|
memcpy(&f, Load(m, m->fpu.dp, 8, b), 8);
|
|
return f;
|
|
}
|
|
|
|
static long double GetMemoryLongDouble(struct Machine *m) {
|
|
long double f;
|
|
uint8_t b[10];
|
|
memcpy(&f, Load(m, m->fpu.dp, 10, b), 10);
|
|
return f;
|
|
}
|
|
|
|
static void SetMemoryShort(struct Machine *m, int16_t i) {
|
|
void *p[2];
|
|
uint8_t b[2];
|
|
Write16(BeginStore(m, m->fpu.dp, 2, p, b), i);
|
|
EndStore(m, m->fpu.dp, 2, p, b);
|
|
}
|
|
|
|
static void SetMemoryInt(struct Machine *m, int32_t i) {
|
|
void *p[2];
|
|
uint8_t b[4];
|
|
Write32(BeginStore(m, m->fpu.dp, 4, p, b), i);
|
|
EndStore(m, m->fpu.dp, 4, p, b);
|
|
}
|
|
|
|
static void SetMemoryLong(struct Machine *m, int64_t i) {
|
|
void *p[2];
|
|
uint8_t b[8];
|
|
Write64(BeginStore(m, m->fpu.dp, 8, p, b), i);
|
|
EndStore(m, m->fpu.dp, 8, p, b);
|
|
}
|
|
|
|
static void SetMemoryFloat(struct Machine *m, float f) {
|
|
void *p[2];
|
|
uint8_t b[4];
|
|
memcpy(BeginStore(m, m->fpu.dp, 4, p, b), &f, 4);
|
|
EndStore(m, m->fpu.dp, 4, p, b);
|
|
}
|
|
|
|
static void SetMemoryDouble(struct Machine *m, double f) {
|
|
void *p[2];
|
|
uint8_t b[8];
|
|
memcpy(BeginStore(m, m->fpu.dp, 8, p, b), &f, 8);
|
|
EndStore(m, m->fpu.dp, 8, p, b);
|
|
}
|
|
|
|
static void SetMemoryLdbl(struct Machine *m, long double f) {
|
|
void *p[2];
|
|
uint8_t b[10];
|
|
memcpy(BeginStore(m, m->fpu.dp, 10, p, b), &f, 10);
|
|
EndStore(m, m->fpu.dp, 10, p, b);
|
|
}
|
|
|
|
static long double FpuDivide(struct Machine *m, long double x, long double y) {
|
|
if (y) {
|
|
return x / y;
|
|
} else {
|
|
m->fpu.ze = true;
|
|
return signbit(x) ? -INFINITY : INFINITY;
|
|
}
|
|
}
|
|
|
|
static long double FpuRound(struct Machine *m, long double x) {
|
|
switch (m->fpu.rc) {
|
|
case 0:
|
|
return nearbyintl(x);
|
|
case 1:
|
|
return floorl(x);
|
|
case 2:
|
|
return ceill(x);
|
|
case 3:
|
|
return truncl(x);
|
|
default:
|
|
unreachable;
|
|
}
|
|
}
|
|
|
|
static void FpuCompare(struct Machine *m, long double y) {
|
|
long double x;
|
|
x = St0(m);
|
|
m->fpu.c1 = false;
|
|
if (!isnan(x) && !isnan(y)) {
|
|
m->fpu.c0 = x < y;
|
|
m->fpu.c2 = false;
|
|
m->fpu.c3 = x == y;
|
|
} else {
|
|
m->fpu.c0 = true;
|
|
m->fpu.c2 = true;
|
|
m->fpu.c3 = true;
|
|
m->fpu.ie = true;
|
|
}
|
|
}
|
|
|
|
static void OpFxam(struct Machine *m) {
|
|
long double x;
|
|
x = *FpuSt(m, 0);
|
|
m->fpu.c1 = !!signbit(x);
|
|
if (FpuGetTag(m, 0) == kFpuTagEmpty) {
|
|
m->fpu.c0 = true;
|
|
m->fpu.c2 = false;
|
|
m->fpu.c3 = true;
|
|
} else {
|
|
switch (fpclassify(x)) {
|
|
case FP_NAN:
|
|
m->fpu.c0 = true;
|
|
m->fpu.c2 = false;
|
|
m->fpu.c3 = false;
|
|
break;
|
|
case FP_INFINITE:
|
|
m->fpu.c0 = true;
|
|
m->fpu.c2 = true;
|
|
m->fpu.c3 = false;
|
|
break;
|
|
case FP_ZERO:
|
|
m->fpu.c0 = false;
|
|
m->fpu.c2 = false;
|
|
m->fpu.c3 = true;
|
|
break;
|
|
case FP_SUBNORMAL:
|
|
m->fpu.c0 = false;
|
|
m->fpu.c2 = true;
|
|
m->fpu.c3 = true;
|
|
break;
|
|
case FP_NORMAL:
|
|
m->fpu.c0 = false;
|
|
m->fpu.c2 = true;
|
|
m->fpu.c3 = false;
|
|
break;
|
|
default:
|
|
abort();
|
|
}
|
|
}
|
|
}
|
|
|
|
static void OpFtst(struct Machine *m) {
|
|
FpuCompare(m, 0);
|
|
}
|
|
|
|
static void OpFcmovb(struct Machine *m) {
|
|
if (GetFlag(m->flags, FLAGS_CF)) {
|
|
FpuSetSt0(m, StRm(m));
|
|
}
|
|
}
|
|
|
|
static void OpFcmove(struct Machine *m) {
|
|
if (GetFlag(m->flags, FLAGS_ZF)) {
|
|
FpuSetSt0(m, StRm(m));
|
|
}
|
|
}
|
|
|
|
static void OpFcmovbe(struct Machine *m) {
|
|
if (GetFlag(m->flags, FLAGS_CF) || GetFlag(m->flags, FLAGS_ZF)) {
|
|
FpuSetSt0(m, StRm(m));
|
|
}
|
|
}
|
|
|
|
static void OpFcmovu(struct Machine *m) {
|
|
if (GetFlag(m->flags, FLAGS_PF)) {
|
|
FpuSetSt0(m, StRm(m));
|
|
}
|
|
}
|
|
|
|
static void OpFcmovnb(struct Machine *m) {
|
|
if (!GetFlag(m->flags, FLAGS_CF)) {
|
|
FpuSetSt0(m, StRm(m));
|
|
}
|
|
}
|
|
|
|
static void OpFcmovne(struct Machine *m) {
|
|
if (!GetFlag(m->flags, FLAGS_ZF)) {
|
|
FpuSetSt0(m, StRm(m));
|
|
}
|
|
}
|
|
|
|
static void OpFcmovnbe(struct Machine *m) {
|
|
if (!(GetFlag(m->flags, FLAGS_CF) || GetFlag(m->flags, FLAGS_ZF))) {
|
|
FpuSetSt0(m, StRm(m));
|
|
}
|
|
}
|
|
|
|
static void OpFcmovnu(struct Machine *m) {
|
|
if (!GetFlag(m->flags, FLAGS_PF)) {
|
|
FpuSetSt0(m, StRm(m));
|
|
}
|
|
}
|
|
|
|
static void OpFchs(struct Machine *m) {
|
|
FpuSetSt0(m, -St0(m));
|
|
}
|
|
|
|
static void OpFabs(struct Machine *m) {
|
|
FpuSetSt0(m, fabsl(St0(m)));
|
|
}
|
|
|
|
static void OpF2xm1(struct Machine *m) {
|
|
FpuSetSt0(m, f2xm1(St0(m)));
|
|
}
|
|
|
|
static void OpFyl2x(struct Machine *m) {
|
|
FpuSetStPop(m, 1, fyl2x(St0(m), St1(m)));
|
|
}
|
|
|
|
static void OpFyl2xp1(struct Machine *m) {
|
|
FpuSetStPop(m, 1, fyl2xp1(St0(m), St1(m)));
|
|
}
|
|
|
|
static void OpFcos(struct Machine *m) {
|
|
FpuClearOutOfRangeIndicator(m);
|
|
FpuSetSt0(m, cosl(St0(m)));
|
|
}
|
|
|
|
static void OpFsin(struct Machine *m) {
|
|
FpuClearOutOfRangeIndicator(m);
|
|
FpuSetSt0(m, sinl(St0(m)));
|
|
}
|
|
|
|
static void OpFptan(struct Machine *m) {
|
|
FpuClearOutOfRangeIndicator(m);
|
|
FpuSetSt0(m, tanl(St0(m)));
|
|
FpuPush(m, 1);
|
|
}
|
|
|
|
static void OpFsincos(struct Machine *m) {
|
|
long double tsin, tcos;
|
|
FpuClearOutOfRangeIndicator(m);
|
|
sincosl(St0(m), &tsin, &tcos);
|
|
FpuSetSt0(m, tsin);
|
|
FpuPush(m, tcos);
|
|
}
|
|
|
|
static void OpFpatan(struct Machine *m) {
|
|
FpuClearRoundup(m);
|
|
FpuSetStPop(m, 1, atan2l(St0(m), St1(m)));
|
|
}
|
|
|
|
static void OpFcom(struct Machine *m) {
|
|
FpuCompare(m, StRm(m));
|
|
}
|
|
|
|
static void OpFcomp(struct Machine *m) {
|
|
FpuCompare(m, StRm(m));
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFaddStEst(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) + StRm(m));
|
|
}
|
|
|
|
static void OpFmulStEst(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) * StRm(m));
|
|
}
|
|
|
|
static void OpFsubStEst(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) - StRm(m));
|
|
}
|
|
|
|
static void OpFsubrStEst(struct Machine *m) {
|
|
FpuSetSt0(m, StRm(m) - St0(m));
|
|
}
|
|
|
|
static void OpFdivStEst(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, St0(m), StRm(m)));
|
|
}
|
|
|
|
static void OpFdivrStEst(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, StRm(m), St0(m)));
|
|
}
|
|
|
|
static void OpFaddEstSt(struct Machine *m) {
|
|
FpuSetStRm(m, StRm(m) + St0(m));
|
|
}
|
|
|
|
static void OpFmulEstSt(struct Machine *m) {
|
|
FpuSetStRm(m, StRm(m) * St0(m));
|
|
}
|
|
|
|
static void OpFsubEstSt(struct Machine *m) {
|
|
FpuSetStRm(m, St0(m) - StRm(m));
|
|
}
|
|
|
|
static void OpFsubrEstSt(struct Machine *m) {
|
|
FpuSetStRm(m, StRm(m) - St0(m));
|
|
}
|
|
|
|
static void OpFdivEstSt(struct Machine *m) {
|
|
FpuSetStRm(m, FpuDivide(m, StRm(m), St0(m)));
|
|
}
|
|
|
|
static void OpFdivrEstSt(struct Machine *m) {
|
|
FpuSetStRm(m, FpuDivide(m, St0(m), StRm(m)));
|
|
}
|
|
|
|
static void OpFaddp(struct Machine *m) {
|
|
FpuSetStRmPop(m, St0(m) + StRm(m));
|
|
}
|
|
|
|
static void OpFmulp(struct Machine *m) {
|
|
FpuSetStRmPop(m, St0(m) * StRm(m));
|
|
}
|
|
|
|
static void OpFcompp(struct Machine *m) {
|
|
OpFcomp(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFsubp(struct Machine *m) {
|
|
FpuSetStRmPop(m, St0(m) - StRm(m));
|
|
}
|
|
|
|
static void OpFsubrp(struct Machine *m) {
|
|
FpuSetStPop(m, 1, StRm(m) - St0(m));
|
|
}
|
|
|
|
static void OpFdivp(struct Machine *m) {
|
|
FpuSetStRmPop(m, FpuDivide(m, St0(m), StRm(m)));
|
|
}
|
|
|
|
static void OpFdivrp(struct Machine *m) {
|
|
FpuSetStRmPop(m, FpuDivide(m, StRm(m), St0(m)));
|
|
}
|
|
|
|
static void OpFadds(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) + GetMemoryFloat(m));
|
|
}
|
|
|
|
static void OpFmuls(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) * GetMemoryFloat(m));
|
|
}
|
|
|
|
static void OpFcoms(struct Machine *m) {
|
|
FpuCompare(m, GetMemoryFloat(m));
|
|
}
|
|
|
|
static void OpFcomps(struct Machine *m) {
|
|
OpFcoms(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFsubs(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) - GetMemoryFloat(m));
|
|
}
|
|
|
|
static void OpFsubrs(struct Machine *m) {
|
|
FpuSetSt0(m, GetMemoryFloat(m) - St0(m));
|
|
}
|
|
|
|
static void OpFdivs(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, St0(m), GetMemoryFloat(m)));
|
|
}
|
|
|
|
static void OpFdivrs(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, GetMemoryFloat(m), St0(m)));
|
|
}
|
|
|
|
static void OpFaddl(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) + GetMemoryDouble(m));
|
|
}
|
|
|
|
static void OpFmull(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) * GetMemoryDouble(m));
|
|
}
|
|
|
|
static void OpFcoml(struct Machine *m) {
|
|
FpuCompare(m, GetMemoryDouble(m));
|
|
}
|
|
|
|
static void OpFcompl(struct Machine *m) {
|
|
FpuCompare(m, GetMemoryDouble(m));
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFsubl(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) - GetMemoryDouble(m));
|
|
}
|
|
|
|
static void OpFsubrl(struct Machine *m) {
|
|
FpuSetSt0(m, GetMemoryDouble(m) - St0(m));
|
|
}
|
|
|
|
static void OpFdivl(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, St0(m), GetMemoryDouble(m)));
|
|
}
|
|
|
|
static void OpFdivrl(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, GetMemoryDouble(m), St0(m)));
|
|
}
|
|
|
|
static void OpFiaddl(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) + GetMemoryInt(m));
|
|
}
|
|
|
|
static void OpFimull(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) * GetMemoryInt(m));
|
|
}
|
|
|
|
static void OpFicoml(struct Machine *m) {
|
|
FpuCompare(m, GetMemoryInt(m));
|
|
}
|
|
|
|
static void OpFicompl(struct Machine *m) {
|
|
OpFicoml(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFisubl(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) - GetMemoryInt(m));
|
|
}
|
|
|
|
static void OpFisubrl(struct Machine *m) {
|
|
FpuSetSt0(m, GetMemoryInt(m) - St0(m));
|
|
}
|
|
|
|
static void OpFidivl(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, St0(m), GetMemoryInt(m)));
|
|
}
|
|
|
|
static void OpFidivrl(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, GetMemoryInt(m), St0(m)));
|
|
}
|
|
|
|
static void OpFiadds(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) + GetMemoryShort(m));
|
|
}
|
|
|
|
static void OpFimuls(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) * GetMemoryShort(m));
|
|
}
|
|
|
|
static void OpFicoms(struct Machine *m) {
|
|
FpuCompare(m, GetMemoryShort(m));
|
|
}
|
|
|
|
static void OpFicomps(struct Machine *m) {
|
|
OpFicoms(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFisubs(struct Machine *m) {
|
|
FpuSetSt0(m, St0(m) - GetMemoryShort(m));
|
|
}
|
|
|
|
static void OpFisubrs(struct Machine *m) {
|
|
FpuSetSt0(m, GetMemoryShort(m) - St0(m));
|
|
}
|
|
|
|
static void OpFidivs(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, St0(m), GetMemoryShort(m)));
|
|
}
|
|
|
|
static void OpFidivrs(struct Machine *m) {
|
|
FpuSetSt0(m, FpuDivide(m, GetMemoryShort(m), St0(m)));
|
|
}
|
|
|
|
static void OpFsqrt(struct Machine *m) {
|
|
FpuClearRoundup(m);
|
|
FpuSetSt0(m, sqrtl(St0(m)));
|
|
}
|
|
|
|
static void OpFrndint(struct Machine *m) {
|
|
FpuSetSt0(m, FpuRound(m, St0(m)));
|
|
}
|
|
|
|
static void OpFscale(struct Machine *m) {
|
|
FpuClearRoundup(m);
|
|
FpuSetSt0(m, fscale(St0(m), St1(m)));
|
|
}
|
|
|
|
static void OpFprem(struct Machine *m) {
|
|
FpuSetSt0(m, fprem(St0(m), St1(m), &m->fpu.sw));
|
|
}
|
|
|
|
static void OpFprem1(struct Machine *m) {
|
|
FpuSetSt0(m, fprem1(St0(m), St1(m), &m->fpu.sw));
|
|
}
|
|
|
|
static void OpFdecstp(struct Machine *m) {
|
|
--m->fpu.sp;
|
|
}
|
|
|
|
static void OpFincstp(struct Machine *m) {
|
|
++m->fpu.sp;
|
|
}
|
|
|
|
static void OpFxtract(struct Machine *m) {
|
|
long double x;
|
|
x = St0(m);
|
|
FpuSetSt0(m, logbl(x));
|
|
FpuPush(m, significandl(x));
|
|
}
|
|
|
|
static void OpFld(struct Machine *m) {
|
|
FpuPush(m, StRm(m));
|
|
}
|
|
|
|
static void OpFlds(struct Machine *m) {
|
|
FpuPush(m, GetMemoryFloat(m));
|
|
}
|
|
|
|
static void OpFsts(struct Machine *m) {
|
|
SetMemoryFloat(m, St0(m));
|
|
}
|
|
|
|
static void OpFstps(struct Machine *m) {
|
|
OpFsts(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFstpt(struct Machine *m) {
|
|
SetMemoryLdbl(m, FpuPop(m));
|
|
}
|
|
|
|
static void OpFstl(struct Machine *m) {
|
|
SetMemoryDouble(m, St0(m));
|
|
}
|
|
|
|
static void OpFstpl(struct Machine *m) {
|
|
OpFstl(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFst(struct Machine *m) {
|
|
FpuSetStRm(m, St0(m));
|
|
}
|
|
|
|
static void OpFstp(struct Machine *m) {
|
|
FpuSetStRmPop(m, St0(m));
|
|
}
|
|
|
|
static void OpFxch(struct Machine *m) {
|
|
long double t = StRm(m);
|
|
FpuSetStRm(m, St0(m));
|
|
FpuSetSt0(m, t);
|
|
}
|
|
|
|
static void OpFldcw(struct Machine *m) {
|
|
m->fpu.cw = GetMemoryShort(m);
|
|
}
|
|
|
|
static void OpFldt(struct Machine *m) {
|
|
FpuPush(m, GetMemoryLongDouble(m));
|
|
}
|
|
|
|
static void OpFldl(struct Machine *m) {
|
|
FpuPush(m, GetMemoryDouble(m));
|
|
}
|
|
|
|
static void OpFldConstant(struct Machine *m) {
|
|
long double x;
|
|
switch (ModrmRm(m->xedd->op.rde)) {
|
|
case 0:
|
|
x = fld1();
|
|
break;
|
|
case 1:
|
|
x = fldl2t();
|
|
break;
|
|
case 2:
|
|
x = fldl2e();
|
|
break;
|
|
case 3:
|
|
x = fldpi();
|
|
break;
|
|
case 4:
|
|
x = fldlg2();
|
|
break;
|
|
case 5:
|
|
x = fldln2();
|
|
break;
|
|
case 6:
|
|
x = fldz();
|
|
break;
|
|
default:
|
|
OpUd(m);
|
|
}
|
|
FpuPush(m, x);
|
|
}
|
|
|
|
static void OpFstcw(struct Machine *m) {
|
|
SetMemoryShort(m, m->fpu.cw);
|
|
}
|
|
|
|
static void OpFilds(struct Machine *m) {
|
|
FpuPush(m, GetMemoryShort(m));
|
|
}
|
|
|
|
static void OpFildl(struct Machine *m) {
|
|
FpuPush(m, GetMemoryInt(m));
|
|
}
|
|
|
|
static void OpFildll(struct Machine *m) {
|
|
FpuPush(m, GetMemoryLong(m));
|
|
}
|
|
|
|
static void OpFisttpl(struct Machine *m) {
|
|
SetMemoryInt(m, FpuPop(m));
|
|
}
|
|
|
|
static void OpFisttpll(struct Machine *m) {
|
|
SetMemoryLong(m, FpuPop(m));
|
|
}
|
|
|
|
static void OpFisttps(struct Machine *m) {
|
|
SetMemoryShort(m, FpuPop(m));
|
|
}
|
|
|
|
static void OpFists(struct Machine *m) {
|
|
SetMemoryShort(m, FpuRound(m, St0(m)));
|
|
}
|
|
|
|
static void OpFistl(struct Machine *m) {
|
|
SetMemoryInt(m, FpuRound(m, St0(m)));
|
|
}
|
|
|
|
static void OpFistll(struct Machine *m) {
|
|
SetMemoryLong(m, FpuRound(m, St0(m)));
|
|
}
|
|
|
|
static void OpFistpl(struct Machine *m) {
|
|
OpFistl(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFistpll(struct Machine *m) {
|
|
OpFistll(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFistps(struct Machine *m) {
|
|
OpFists(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFcomi(struct Machine *m) {
|
|
long double x, y;
|
|
x = St0(m);
|
|
y = StRm(m);
|
|
if (!isnan(x) && !isnan(y)) {
|
|
m->flags = SetFlag(m->flags, FLAGS_ZF, x == y);
|
|
m->flags = SetFlag(m->flags, FLAGS_CF, x < y);
|
|
m->flags = SetFlag(m->flags, FLAGS_PF, false);
|
|
} else {
|
|
m->fpu.ie = true;
|
|
m->flags = SetFlag(m->flags, FLAGS_ZF, true);
|
|
m->flags = SetFlag(m->flags, FLAGS_CF, true);
|
|
m->flags = SetFlag(m->flags, FLAGS_PF, true);
|
|
}
|
|
}
|
|
|
|
static void OpFucom(struct Machine *m) {
|
|
FpuCompare(m, StRm(m));
|
|
}
|
|
|
|
static void OpFucomp(struct Machine *m) {
|
|
FpuCompare(m, StRm(m));
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFcomip(struct Machine *m) {
|
|
OpFcomi(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFucomi(struct Machine *m) {
|
|
OpFcomi(m);
|
|
}
|
|
|
|
static void OpFucomip(struct Machine *m) {
|
|
OpFcomip(m);
|
|
}
|
|
|
|
static void OpFfree(struct Machine *m) {
|
|
FpuSetTag(m, ModrmRm(m->xedd->op.rde), kFpuTagEmpty);
|
|
}
|
|
|
|
static void OpFfreep(struct Machine *m) {
|
|
OpFfree(m);
|
|
FpuPop(m);
|
|
}
|
|
|
|
static void OpFstswMw(struct Machine *m) {
|
|
SetMemoryShort(m, m->fpu.sw);
|
|
}
|
|
|
|
static void OpFstswAx(struct Machine *m) {
|
|
Write16(m->ax, m->fpu.sw);
|
|
}
|
|
|
|
static void SetFpuEnv(struct Machine *m, uint8_t p[28]) {
|
|
Write16(p + 0, m->fpu.cw);
|
|
Write16(p + 4, m->fpu.sw);
|
|
Write16(p + 8, m->fpu.tw);
|
|
Write64(p + 12, m->fpu.ip);
|
|
Write16(p + 18, m->fpu.op);
|
|
Write64(p + 20, m->fpu.dp);
|
|
}
|
|
|
|
static void GetFpuEnv(struct Machine *m, uint8_t p[28]) {
|
|
m->fpu.cw = Read16(p + 0);
|
|
m->fpu.sw = Read16(p + 4);
|
|
m->fpu.tw = Read16(p + 8);
|
|
}
|
|
|
|
static void OpFstenv(struct Machine *m) {
|
|
void *p[2];
|
|
uint8_t b[28];
|
|
SetFpuEnv(m, BeginStore(m, m->fpu.dp, sizeof(b), p, b));
|
|
EndStore(m, m->fpu.dp, sizeof(b), p, b);
|
|
}
|
|
|
|
static void OpFldenv(struct Machine *m) {
|
|
uint8_t b[28];
|
|
GetFpuEnv(m, Load(m, m->fpu.dp, sizeof(b), b));
|
|
}
|
|
|
|
static void OpFsave(struct Machine *m) {
|
|
long i;
|
|
void *p[2];
|
|
long double x;
|
|
uint8_t *a, b[108];
|
|
a = BeginStore(m, m->fpu.dp, sizeof(b), p, b);
|
|
SetFpuEnv(m, a);
|
|
for (i = 0; i < 8; ++i) {
|
|
x = *FpuSt(m, i);
|
|
memcpy(a + 28 + i * 10, &x, 10);
|
|
}
|
|
EndStore(m, m->fpu.dp, sizeof(b), p, b);
|
|
OpFinit(m);
|
|
}
|
|
|
|
static void OpFrstor(struct Machine *m) {
|
|
long i;
|
|
long double x;
|
|
uint8_t *a, b[108];
|
|
a = Load(m, m->fpu.dp, sizeof(b), b);
|
|
GetFpuEnv(m, a);
|
|
for (i = 0; i < 8; ++i) {
|
|
memset(&x, 0, sizeof(x));
|
|
memcpy(&x, a + 28 + i * 10, 10);
|
|
*FpuSt(m, i) = x;
|
|
}
|
|
}
|
|
|
|
static void OpFnclex(struct Machine *m) {
|
|
m->fpu.ie = false;
|
|
m->fpu.de = false;
|
|
m->fpu.ze = false;
|
|
m->fpu.oe = false;
|
|
m->fpu.ue = false;
|
|
m->fpu.pe = false;
|
|
m->fpu.es = false;
|
|
m->fpu.bf = false;
|
|
}
|
|
|
|
static void OpFnop(struct Machine *m) {
|
|
/* do nothing */
|
|
}
|
|
|
|
void OpFinit(struct Machine *m) {
|
|
m->fpu.cw = X87_NORMAL;
|
|
m->fpu.sw = 0;
|
|
m->fpu.tw = -1;
|
|
}
|
|
|
|
void OpFwait(struct Machine *m) {
|
|
if ((m->fpu.ie & !m->fpu.im) | (m->fpu.de & !m->fpu.dm) |
|
|
(m->fpu.ze & !m->fpu.zm) | (m->fpu.oe & !m->fpu.om) |
|
|
(m->fpu.ue & !m->fpu.um) | (m->fpu.pe & !m->fpu.pm) |
|
|
(m->fpu.sf & !m->fpu.im)) {
|
|
HaltMachine(m, kMachineFpuException);
|
|
}
|
|
}
|
|
|
|
long double *FpuSt(struct Machine *m, unsigned i) {
|
|
i += m->fpu.sp;
|
|
i &= 0b111;
|
|
return m->fpu.st + i;
|
|
}
|
|
|
|
int FpuGetTag(struct Machine *m, unsigned i) {
|
|
unsigned t;
|
|
t = m->fpu.tw;
|
|
i += m->fpu.sp;
|
|
i &= 0b111;
|
|
i *= 2;
|
|
t &= 0b11 << i;
|
|
t >>= i;
|
|
return t;
|
|
}
|
|
|
|
void FpuSetTag(struct Machine *m, unsigned i, unsigned t) {
|
|
i += m->fpu.sp;
|
|
t &= 0b11;
|
|
i &= 0b111;
|
|
i *= 2;
|
|
m->fpu.tw &= ~(0b11 << i);
|
|
m->fpu.tw |= t << i;
|
|
}
|
|
|
|
void FpuPush(struct Machine *m, long double x) {
|
|
if (FpuGetTag(m, -1) != kFpuTagEmpty) OnFpuStackOverflow(m);
|
|
m->fpu.sp -= 1;
|
|
*FpuSt(m, 0) = x;
|
|
FpuSetTag(m, 0, kFpuTagValid);
|
|
}
|
|
|
|
long double FpuPop(struct Machine *m) {
|
|
long double x;
|
|
if (FpuGetTag(m, 0) != kFpuTagEmpty) {
|
|
x = *FpuSt(m, 0);
|
|
FpuSetTag(m, 0, kFpuTagEmpty);
|
|
} else {
|
|
x = OnFpuStackUnderflow(m);
|
|
}
|
|
m->fpu.sp += 1;
|
|
return x;
|
|
}
|
|
|
|
void OpFpu(struct Machine *m) {
|
|
unsigned op;
|
|
bool ismemory;
|
|
op = m->xedd->op.opcode & 0b111;
|
|
ismemory = ModrmMod(m->xedd->op.rde) != 0b11;
|
|
m->fpu.ip = m->ip - m->xedd->length;
|
|
m->fpu.op = op << 8 | m->xedd->op.modrm;
|
|
m->fpu.dp = ismemory ? ComputeAddress(m, m->xedd->op.rde) : 0;
|
|
switch (DISP(op, ismemory, m->xedd->op.reg)) {
|
|
CASE(DISP(0xD8, FPUREG, 0), OpFaddStEst(m));
|
|
CASE(DISP(0xD8, FPUREG, 1), OpFmulStEst(m));
|
|
CASE(DISP(0xD8, FPUREG, 2), OpFcom(m));
|
|
CASE(DISP(0xD8, FPUREG, 3), OpFcomp(m));
|
|
CASE(DISP(0xD8, FPUREG, 4), OpFsubStEst(m));
|
|
CASE(DISP(0xD8, FPUREG, 5), OpFsubrStEst(m));
|
|
CASE(DISP(0xD8, FPUREG, 6), OpFdivStEst(m));
|
|
CASE(DISP(0xD8, FPUREG, 7), OpFdivrStEst(m));
|
|
CASE(DISP(0xD8, MEMORY, 0), OpFadds(m));
|
|
CASE(DISP(0xD8, MEMORY, 1), OpFmuls(m));
|
|
CASE(DISP(0xD8, MEMORY, 2), OpFcoms(m));
|
|
CASE(DISP(0xD8, MEMORY, 3), OpFcomps(m));
|
|
CASE(DISP(0xD8, MEMORY, 4), OpFsubs(m));
|
|
CASE(DISP(0xD8, MEMORY, 5), OpFsubrs(m));
|
|
CASE(DISP(0xD8, MEMORY, 6), OpFdivs(m));
|
|
CASE(DISP(0xD8, MEMORY, 7), OpFdivrs(m));
|
|
CASE(DISP(0xD9, FPUREG, 0), OpFld(m));
|
|
CASE(DISP(0xD9, FPUREG, 1), OpFxch(m));
|
|
CASE(DISP(0xD9, FPUREG, 2), OpFnop(m));
|
|
CASE(DISP(0xD9, FPUREG, 3), OpFstp(m));
|
|
CASE(DISP(0xD9, FPUREG, 5), OpFldConstant(m));
|
|
CASE(DISP(0xD9, MEMORY, 0), OpFlds(m));
|
|
CASE(DISP(0xD9, MEMORY, 2), OpFsts(m));
|
|
CASE(DISP(0xD9, MEMORY, 3), OpFstps(m));
|
|
CASE(DISP(0xD9, MEMORY, 4), OpFldenv(m));
|
|
CASE(DISP(0xD9, MEMORY, 5), OpFldcw(m));
|
|
CASE(DISP(0xD9, MEMORY, 6), OpFstenv(m));
|
|
CASE(DISP(0xD9, MEMORY, 7), OpFstcw(m));
|
|
CASE(DISP(0xDA, FPUREG, 0), OpFcmovb(m));
|
|
CASE(DISP(0xDA, FPUREG, 1), OpFcmove(m));
|
|
CASE(DISP(0xDA, FPUREG, 2), OpFcmovbe(m));
|
|
CASE(DISP(0xDA, FPUREG, 3), OpFcmovu(m));
|
|
CASE(DISP(0xDA, MEMORY, 0), OpFiaddl(m));
|
|
CASE(DISP(0xDa, MEMORY, 1), OpFimull(m));
|
|
CASE(DISP(0xDa, MEMORY, 2), OpFicoml(m));
|
|
CASE(DISP(0xDa, MEMORY, 3), OpFicompl(m));
|
|
CASE(DISP(0xDa, MEMORY, 4), OpFisubl(m));
|
|
CASE(DISP(0xDa, MEMORY, 5), OpFisubrl(m));
|
|
CASE(DISP(0xDa, MEMORY, 6), OpFidivl(m));
|
|
CASE(DISP(0xDa, MEMORY, 7), OpFidivrl(m));
|
|
CASE(DISP(0xDb, FPUREG, 0), OpFcmovnb(m));
|
|
CASE(DISP(0xDb, FPUREG, 1), OpFcmovne(m));
|
|
CASE(DISP(0xDb, FPUREG, 2), OpFcmovnbe(m));
|
|
CASE(DISP(0xDb, FPUREG, 3), OpFcmovnu(m));
|
|
CASE(DISP(0xDb, FPUREG, 5), OpFucomi(m));
|
|
CASE(DISP(0xDb, FPUREG, 6), OpFcomi(m));
|
|
CASE(DISP(0xDb, MEMORY, 0), OpFildl(m));
|
|
CASE(DISP(0xDb, MEMORY, 1), OpFisttpl(m));
|
|
CASE(DISP(0xDb, MEMORY, 2), OpFistl(m));
|
|
CASE(DISP(0xDb, MEMORY, 3), OpFistpl(m));
|
|
CASE(DISP(0xDb, MEMORY, 5), OpFldt(m));
|
|
CASE(DISP(0xDb, MEMORY, 7), OpFstpt(m));
|
|
CASE(DISP(0xDc, FPUREG, 0), OpFaddEstSt(m));
|
|
CASE(DISP(0xDc, FPUREG, 1), OpFmulEstSt(m));
|
|
CASE(DISP(0xDc, FPUREG, 2), OpFcom(m));
|
|
CASE(DISP(0xDc, FPUREG, 3), OpFcomp(m));
|
|
CASE(DISP(0xDc, FPUREG, 4), OpFsubEstSt(m));
|
|
CASE(DISP(0xDc, FPUREG, 5), OpFsubrEstSt(m));
|
|
CASE(DISP(0xDc, FPUREG, 6), OpFdivEstSt(m));
|
|
CASE(DISP(0xDc, FPUREG, 7), OpFdivrEstSt(m));
|
|
CASE(DISP(0xDc, MEMORY, 0), OpFaddl(m));
|
|
CASE(DISP(0xDc, MEMORY, 1), OpFmull(m));
|
|
CASE(DISP(0xDc, MEMORY, 2), OpFcoml(m));
|
|
CASE(DISP(0xDc, MEMORY, 3), OpFcompl(m));
|
|
CASE(DISP(0xDc, MEMORY, 4), OpFsubl(m));
|
|
CASE(DISP(0xDc, MEMORY, 5), OpFsubrl(m));
|
|
CASE(DISP(0xDc, MEMORY, 6), OpFdivl(m));
|
|
CASE(DISP(0xDc, MEMORY, 7), OpFdivrl(m));
|
|
CASE(DISP(0xDd, FPUREG, 0), OpFfree(m));
|
|
CASE(DISP(0xDd, FPUREG, 1), OpFxch(m));
|
|
CASE(DISP(0xDd, FPUREG, 2), OpFst(m));
|
|
CASE(DISP(0xDd, FPUREG, 3), OpFstp(m));
|
|
CASE(DISP(0xDd, FPUREG, 4), OpFucom(m));
|
|
CASE(DISP(0xDd, FPUREG, 5), OpFucomp(m));
|
|
CASE(DISP(0xDd, MEMORY, 0), OpFldl(m));
|
|
CASE(DISP(0xDd, MEMORY, 1), OpFisttpll(m));
|
|
CASE(DISP(0xDd, MEMORY, 2), OpFstl(m));
|
|
CASE(DISP(0xDd, MEMORY, 3), OpFstpl(m));
|
|
CASE(DISP(0xDd, MEMORY, 4), OpFrstor(m));
|
|
CASE(DISP(0xDd, MEMORY, 6), OpFsave(m));
|
|
CASE(DISP(0xDd, MEMORY, 7), OpFstswMw(m));
|
|
CASE(DISP(0xDe, FPUREG, 0), OpFaddp(m));
|
|
CASE(DISP(0xDe, FPUREG, 1), OpFmulp(m));
|
|
CASE(DISP(0xDe, FPUREG, 2), OpFcomp(m));
|
|
CASE(DISP(0xDe, FPUREG, 3), OpFcompp(m));
|
|
CASE(DISP(0xDe, FPUREG, 4), OpFsubp(m));
|
|
CASE(DISP(0xDe, FPUREG, 5), OpFsubrp(m));
|
|
CASE(DISP(0xDe, FPUREG, 6), OpFdivp(m));
|
|
CASE(DISP(0xDe, FPUREG, 7), OpFdivrp(m));
|
|
CASE(DISP(0xDe, MEMORY, 0), OpFiadds(m));
|
|
CASE(DISP(0xDe, MEMORY, 1), OpFimuls(m));
|
|
CASE(DISP(0xDe, MEMORY, 2), OpFicoms(m));
|
|
CASE(DISP(0xDe, MEMORY, 3), OpFicomps(m));
|
|
CASE(DISP(0xDe, MEMORY, 4), OpFisubs(m));
|
|
CASE(DISP(0xDe, MEMORY, 5), OpFisubrs(m));
|
|
CASE(DISP(0xDe, MEMORY, 6), OpFidivs(m));
|
|
CASE(DISP(0xDe, MEMORY, 7), OpFidivrs(m));
|
|
CASE(DISP(0xDf, FPUREG, 0), OpFfreep(m));
|
|
CASE(DISP(0xDf, FPUREG, 1), OpFxch(m));
|
|
CASE(DISP(0xDf, FPUREG, 2), OpFstp(m));
|
|
CASE(DISP(0xDf, FPUREG, 3), OpFstp(m));
|
|
CASE(DISP(0xDf, FPUREG, 4), OpFstswAx(m));
|
|
CASE(DISP(0xDf, FPUREG, 5), OpFucomip(m));
|
|
CASE(DISP(0xDf, FPUREG, 6), OpFcomip(m));
|
|
CASE(DISP(0xDf, MEMORY, 0), OpFilds(m));
|
|
CASE(DISP(0xDf, MEMORY, 1), OpFisttps(m));
|
|
CASE(DISP(0xDf, MEMORY, 2), OpFists(m));
|
|
CASE(DISP(0xDf, MEMORY, 3), OpFistps(m));
|
|
CASE(DISP(0xDf, MEMORY, 5), OpFildll(m));
|
|
CASE(DISP(0xDf, MEMORY, 7), OpFistpll(m));
|
|
case DISP(0xD9, FPUREG, 4):
|
|
switch (ModrmRm(m->xedd->op.rde)) {
|
|
CASE(0, OpFchs(m));
|
|
CASE(1, OpFabs(m));
|
|
CASE(4, OpFtst(m));
|
|
CASE(5, OpFxam(m));
|
|
default:
|
|
OpUd(m);
|
|
}
|
|
break;
|
|
case DISP(0xD9, FPUREG, 6):
|
|
switch (ModrmRm(m->xedd->op.rde)) {
|
|
CASE(0, OpF2xm1(m));
|
|
CASE(1, OpFyl2x(m));
|
|
CASE(2, OpFptan(m));
|
|
CASE(3, OpFpatan(m));
|
|
CASE(4, OpFxtract(m));
|
|
CASE(5, OpFprem1(m));
|
|
CASE(6, OpFdecstp(m));
|
|
CASE(7, OpFincstp(m));
|
|
default:
|
|
unreachable;
|
|
}
|
|
break;
|
|
case DISP(0xD9, FPUREG, 7):
|
|
switch (ModrmRm(m->xedd->op.rde)) {
|
|
CASE(0, OpFprem(m));
|
|
CASE(1, OpFyl2xp1(m));
|
|
CASE(2, OpFsqrt(m));
|
|
CASE(3, OpFsincos(m));
|
|
CASE(4, OpFrndint(m));
|
|
CASE(5, OpFscale(m));
|
|
CASE(6, OpFsin(m));
|
|
CASE(7, OpFcos(m));
|
|
default:
|
|
unreachable;
|
|
}
|
|
break;
|
|
case DISP(0xDb, FPUREG, 4):
|
|
switch (ModrmRm(m->xedd->op.rde)) {
|
|
CASE(2, OpFnclex(m));
|
|
CASE(3, OpFinit(m));
|
|
default:
|
|
OpUd(m);
|
|
}
|
|
break;
|
|
default:
|
|
OpUd(m);
|
|
}
|
|
}
|