/*-*- 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/word.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 FpuGetMemoryShort(struct Machine *m) { uint8_t b[2]; return Read16(Load(m, m->fpu.dp, 2, b)); } static int32_t FpuGetMemoryInt(struct Machine *m) { uint8_t b[4]; return Read32(Load(m, m->fpu.dp, 4, b)); } static int64_t FpuGetMemoryLong(struct Machine *m) { uint8_t b[8]; return Read64(Load(m, m->fpu.dp, 8, b)); } static float FpuGetMemoryFloat(struct Machine *m) { float f; uint8_t b[4]; memcpy(&f, Load(m, m->fpu.dp, 4, b), 4); return f; } static double FpuGetMemoryDouble(struct Machine *m) { double f; uint8_t b[8]; memcpy(&f, Load(m, m->fpu.dp, 8, b), 8); return f; } static long double FpuGetMemoryLongDouble(struct Machine *m) { long double f; uint8_t b[10]; memcpy(&f, Load(m, m->fpu.dp, 10, b), 10); return f; } static void FpuSetMemoryShort(struct Machine *m, int16_t i) { SetMemoryShort(m, m->fpu.dp, i); } static void FpuSetMemoryInt(struct Machine *m, int32_t i) { SetMemoryInt(m, m->fpu.dp, i); } static void FpuSetMemoryLong(struct Machine *m, int64_t i) { SetMemoryLong(m, m->fpu.dp, i); } static void FpuSetMemoryFloat(struct Machine *m, float f) { SetMemoryFloat(m, m->fpu.dp, f); } static void FpuSetMemoryDouble(struct Machine *m, double f) { SetMemoryDouble(m, m->fpu.dp, f); } static void FpuSetMemoryLdbl(struct Machine *m, long double f) { SetMemoryLdbl(m, m->fpu.dp, f); } static long double FpuAdd(struct Machine *m, long double x, long double y) { if (!isunordered(x, y)) { switch (isinf(y) << 1 | isinf(x)) { case 0b00: return x + y; case 0b01: return x; case 0b10: return y; case 0b11: if (signbit(x) == signbit(y)) { return x; } else { m->fpu.ie = true; return copysign(NAN, x); } default: unreachable; } } else { return NAN; } } static long double FpuSub(struct Machine *m, long double x, long double y) { if (!isunordered(x, y)) { switch (isinf(y) << 1 | isinf(x)) { case 0b00: return x - y; case 0b01: return -x; case 0b10: return y; case 0b11: if (signbit(x) == signbit(y)) { m->fpu.ie = true; return copysign(NAN, x); } else { return y; } default: unreachable; } } else { return NAN; } } static long double FpuMul(struct Machine *m, long double x, long double y) { if (!isunordered(x, y)) { if (!((isinf(x) && !y) || (isinf(y) && !x))) { return x * y; } else { m->fpu.ie = true; return -NAN; } } else { return NAN; } } static long double FpuDiv(struct Machine *m, long double x, long double y) { if (!isunordered(x, y)) { if (x || y) { if (y) { return x / y; } else { m->fpu.ze = true; return copysign(INFINITY, x); } } else { m->fpu.ie = true; return copysign(NAN, x); } } else { return NAN; } } 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 (!isunordered(x, 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; } } 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, FpuAdd(m, St0(m), StRm(m))); } static void OpFmulStEst(struct Machine *m) { FpuSetSt0(m, FpuMul(m, St0(m), StRm(m))); } static void OpFsubStEst(struct Machine *m) { FpuSetSt0(m, FpuSub(m, St0(m), StRm(m))); } static void OpFsubrStEst(struct Machine *m) { FpuSetSt0(m, FpuSub(m, StRm(m), St0(m))); } static void OpFdivStEst(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, St0(m), StRm(m))); } static void OpFdivrStEst(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, StRm(m), St0(m))); } static void OpFaddEstSt(struct Machine *m) { FpuSetStRm(m, FpuAdd(m, StRm(m), St0(m))); } static void OpFmulEstSt(struct Machine *m) { FpuSetStRm(m, FpuMul(m, StRm(m), St0(m))); } static void OpFsubEstSt(struct Machine *m) { FpuSetStRm(m, FpuSub(m, St0(m), StRm(m))); } static void OpFsubrEstSt(struct Machine *m) { FpuSetStRm(m, FpuSub(m, StRm(m), St0(m))); } static void OpFdivEstSt(struct Machine *m) { FpuSetStRm(m, FpuDiv(m, StRm(m), St0(m))); } static void OpFdivrEstSt(struct Machine *m) { FpuSetStRm(m, FpuDiv(m, St0(m), StRm(m))); } static void OpFaddp(struct Machine *m) { FpuSetStRmPop(m, FpuAdd(m, St0(m), StRm(m))); } static void OpFmulp(struct Machine *m) { FpuSetStRmPop(m, FpuMul(m, St0(m), StRm(m))); } static void OpFcompp(struct Machine *m) { OpFcomp(m); FpuPop(m); } static void OpFsubp(struct Machine *m) { FpuSetStRmPop(m, FpuSub(m, St0(m), StRm(m))); } static void OpFsubrp(struct Machine *m) { FpuSetStPop(m, 1, FpuSub(m, StRm(m), St0(m))); } static void OpFdivp(struct Machine *m) { FpuSetStRmPop(m, FpuDiv(m, St0(m), StRm(m))); } static void OpFdivrp(struct Machine *m) { FpuSetStRmPop(m, FpuDiv(m, StRm(m), St0(m))); } static void OpFadds(struct Machine *m) { FpuSetSt0(m, FpuAdd(m, St0(m), FpuGetMemoryFloat(m))); } static void OpFmuls(struct Machine *m) { FpuSetSt0(m, FpuMul(m, St0(m), FpuGetMemoryFloat(m))); } static void OpFcoms(struct Machine *m) { FpuCompare(m, FpuGetMemoryFloat(m)); } static void OpFcomps(struct Machine *m) { OpFcoms(m); FpuPop(m); } static void OpFsubs(struct Machine *m) { FpuSetSt0(m, FpuSub(m, St0(m), FpuGetMemoryFloat(m))); } static void OpFsubrs(struct Machine *m) { FpuSetSt0(m, FpuSub(m, FpuGetMemoryFloat(m), St0(m))); } static void OpFdivs(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, St0(m), FpuGetMemoryFloat(m))); } static void OpFdivrs(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, FpuGetMemoryFloat(m), St0(m))); } static void OpFaddl(struct Machine *m) { FpuSetSt0(m, FpuAdd(m, St0(m), FpuGetMemoryDouble(m))); } static void OpFmull(struct Machine *m) { FpuSetSt0(m, FpuMul(m, St0(m), FpuGetMemoryDouble(m))); } static void OpFcoml(struct Machine *m) { FpuCompare(m, FpuGetMemoryDouble(m)); } static void OpFcompl(struct Machine *m) { FpuCompare(m, FpuGetMemoryDouble(m)); FpuPop(m); } static void OpFsubl(struct Machine *m) { FpuSetSt0(m, FpuSub(m, St0(m), FpuGetMemoryDouble(m))); } static void OpFsubrl(struct Machine *m) { FpuSetSt0(m, FpuSub(m, FpuGetMemoryDouble(m), St0(m))); } static void OpFdivl(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, St0(m), FpuGetMemoryDouble(m))); } static void OpFdivrl(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, FpuGetMemoryDouble(m), St0(m))); } static void OpFiaddl(struct Machine *m) { FpuSetSt0(m, FpuAdd(m, St0(m), FpuGetMemoryInt(m))); } static void OpFimull(struct Machine *m) { FpuSetSt0(m, FpuMul(m, St0(m), FpuGetMemoryInt(m))); } static void OpFicoml(struct Machine *m) { FpuCompare(m, FpuGetMemoryInt(m)); } static void OpFicompl(struct Machine *m) { OpFicoml(m); FpuPop(m); } static void OpFisubl(struct Machine *m) { FpuSetSt0(m, FpuSub(m, St0(m), FpuGetMemoryInt(m))); } static void OpFisubrl(struct Machine *m) { FpuSetSt0(m, FpuSub(m, FpuGetMemoryInt(m), St0(m))); } static void OpFidivl(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, St0(m), FpuGetMemoryInt(m))); } static void OpFidivrl(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, FpuGetMemoryInt(m), St0(m))); } static void OpFiadds(struct Machine *m) { FpuSetSt0(m, FpuAdd(m, St0(m), FpuGetMemoryShort(m))); } static void OpFimuls(struct Machine *m) { FpuSetSt0(m, FpuMul(m, St0(m), FpuGetMemoryShort(m))); } static void OpFicoms(struct Machine *m) { FpuCompare(m, FpuGetMemoryShort(m)); } static void OpFicomps(struct Machine *m) { OpFicoms(m); FpuPop(m); } static void OpFisubs(struct Machine *m) { FpuSetSt0(m, FpuSub(m, St0(m), FpuGetMemoryShort(m))); } static void OpFisubrs(struct Machine *m) { FpuSetSt0(m, FpuSub(m, FpuGetMemoryShort(m), St0(m))); } static void OpFidivs(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, St0(m), FpuGetMemoryShort(m))); } static void OpFidivrs(struct Machine *m) { FpuSetSt0(m, FpuDiv(m, FpuGetMemoryShort(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, FpuGetMemoryFloat(m)); } static void OpFsts(struct Machine *m) { FpuSetMemoryFloat(m, St0(m)); } static void OpFstps(struct Machine *m) { OpFsts(m); FpuPop(m); } static void OpFstpt(struct Machine *m) { FpuSetMemoryLdbl(m, FpuPop(m)); } static void OpFstl(struct Machine *m) { FpuSetMemoryDouble(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 = FpuGetMemoryShort(m); } static void OpFldt(struct Machine *m) { FpuPush(m, FpuGetMemoryLongDouble(m)); } static void OpFldl(struct Machine *m) { FpuPush(m, FpuGetMemoryDouble(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) { FpuSetMemoryShort(m, m->fpu.cw); } static void OpFilds(struct Machine *m) { FpuPush(m, FpuGetMemoryShort(m)); } static void OpFildl(struct Machine *m) { FpuPush(m, FpuGetMemoryInt(m)); } static void OpFildll(struct Machine *m) { FpuPush(m, FpuGetMemoryLong(m)); } static void OpFisttpl(struct Machine *m) { FpuSetMemoryInt(m, FpuPop(m)); } static void OpFisttpll(struct Machine *m) { FpuSetMemoryLong(m, FpuPop(m)); } static void OpFisttps(struct Machine *m) { FpuSetMemoryShort(m, FpuPop(m)); } static void OpFists(struct Machine *m) { FpuSetMemoryShort(m, FpuRound(m, St0(m))); } static void OpFistl(struct Machine *m) { FpuSetMemoryInt(m, FpuRound(m, St0(m))); } static void OpFistll(struct Machine *m) { FpuSetMemoryLong(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 (!isunordered(x, 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) { FpuSetMemoryShort(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); } }