JIT: implement fres

Mostly a straightforward translation of the interpreter code, with a few
tricksy optimizations and fallbacks for rare paths.

1 files changed, 65 insertions, 0 deletions

diff --git a/Source/Core/Common/MathUtil.cpp b/Source/Core/Common/MathUtil.cpp
index 36b1b85eaa..fb48e15df6 100644
--- a/Source/Core/Common/MathUtil.cpp
+++ b/Source/Core/Common/MathUtil.cpp
@@ -169,6 +169,71 @@ double ApproximateReciprocalSquareRoot(double val)
 	return valf;
 }
 
+const int fres_expected_base[] =
+{
+	0x7ff800, 0x783800, 0x70ea00, 0x6a0800,
+	0x638800, 0x5d6200, 0x579000, 0x520800,
+	0x4cc800, 0x47ca00, 0x430800, 0x3e8000,
+	0x3a2c00, 0x360800, 0x321400, 0x2e4a00,
+	0x2aa800, 0x272c00, 0x23d600, 0x209e00,
+	0x1d8800, 0x1a9000, 0x17ae00, 0x14f800,
+	0x124400, 0x0fbe00, 0x0d3800, 0x0ade00,
+	0x088400, 0x065000, 0x041c00, 0x020c00,
+};
+const int fres_expected_dec[] =
+{
+	0x3e1, 0x3a7, 0x371, 0x340,
+	0x313, 0x2ea, 0x2c4, 0x2a0,
+	0x27f, 0x261, 0x245, 0x22a,
+	0x212, 0x1fb, 0x1e5, 0x1d1,
+	0x1be, 0x1ac, 0x19b, 0x18b,
+	0x17c, 0x16e, 0x15b, 0x15b,
+	0x143, 0x143, 0x12d, 0x12d,
+	0x11a, 0x11a, 0x108, 0x106,
+};
+
+// Used by fres and ps_res.
+double ApproximateReciprocal(double val)
+{
+	union
+	{
+		double valf;
+		s64 vali;
+	};
+
+	valf = val;
+	s64 mantissa = vali & ((1LL << 52) - 1);
+	s64 sign = vali & (1ULL << 63);
+	s64 exponent = vali & (0x7FFLL << 52);
+
+	// Special case 0
+	if (mantissa == 0 && exponent == 0)
+		return sign ? -std::numeric_limits<double>::infinity() : std::numeric_limits<double>::infinity();
+
+	// Special case NaN-ish numbers
+	if (exponent == (0x7FFLL << 52))
+	{
+		if (mantissa == 0)
+			return sign ? -0.0 : 0.0;
+		return 0.0 + valf;
+	}
+
+	// Special case small inputs
+	if (exponent < (895LL << 52))
+		return sign ? -std::numeric_limits<float>::max() : std::numeric_limits<float>::max();
+
+	// Special case large inputs
+	if (exponent >= (1149LL << 52))
+		return sign ? -0.0f : 0.0f;
+
+	exponent = (0x7FDLL << 52) - exponent;
+
+	int i = (int)(mantissa >> 37);
+	vali = sign | exponent;
+	vali |= (s64)(fres_expected_base[i / 1024] - (fres_expected_dec[i / 1024] * (i % 1024) + 1) / 2) << 29;
+	return valf;
+}
+
 }  // namespace
 
 inline void MatrixMul(int n, const float *a, const float *b, float *result)