|
|
@@ -1,4 +1,7 @@
|
|
|
+using ChocolArm64.State;
|
|
|
using System;
|
|
|
+using System.Diagnostics;
|
|
|
+using System.Runtime.CompilerServices;
|
|
|
|
|
|
namespace ChocolArm64.Instruction
|
|
|
{
|
|
|
@@ -6,40 +9,13 @@ namespace ChocolArm64.Instruction
|
|
|
{
|
|
|
static ASoftFloat()
|
|
|
{
|
|
|
+ RecipEstimateTable = BuildRecipEstimateTable();
|
|
|
InvSqrtEstimateTable = BuildInvSqrtEstimateTable();
|
|
|
- RecipEstimateTable = BuildRecipEstimateTable();
|
|
|
}
|
|
|
|
|
|
private static readonly byte[] RecipEstimateTable;
|
|
|
private static readonly byte[] InvSqrtEstimateTable;
|
|
|
|
|
|
- private static byte[] BuildInvSqrtEstimateTable()
|
|
|
- {
|
|
|
- byte[] Table = new byte[512];
|
|
|
- for (ulong index = 128; index < 512; index++)
|
|
|
- {
|
|
|
- ulong a = index;
|
|
|
- if (a < 256)
|
|
|
- {
|
|
|
- a = (a << 1) + 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- a = (a | 1) << 1;
|
|
|
- }
|
|
|
-
|
|
|
- ulong b = 256;
|
|
|
- while (a * (b + 1) * (b + 1) < (1ul << 28))
|
|
|
- {
|
|
|
- b++;
|
|
|
- }
|
|
|
- b = (b + 1) >> 1;
|
|
|
-
|
|
|
- Table[index] = (byte)(b & 0xFF);
|
|
|
- }
|
|
|
- return Table;
|
|
|
- }
|
|
|
-
|
|
|
private static byte[] BuildRecipEstimateTable()
|
|
|
{
|
|
|
byte[] Table = new byte[256];
|
|
|
@@ -56,74 +32,34 @@ namespace ChocolArm64.Instruction
|
|
|
return Table;
|
|
|
}
|
|
|
|
|
|
- public static float InvSqrtEstimate(float x)
|
|
|
- {
|
|
|
- return (float)InvSqrtEstimate((double)x);
|
|
|
- }
|
|
|
-
|
|
|
- public static double InvSqrtEstimate(double x)
|
|
|
+ private static byte[] BuildInvSqrtEstimateTable()
|
|
|
{
|
|
|
- ulong x_bits = (ulong)BitConverter.DoubleToInt64Bits(x);
|
|
|
- ulong x_sign = x_bits & 0x8000000000000000;
|
|
|
- long x_exp = (long)((x_bits >> 52) & 0x7FF);
|
|
|
- ulong scaled = x_bits & ((1ul << 52) - 1);
|
|
|
-
|
|
|
- if (x_exp == 0x7FF && scaled != 0)
|
|
|
- {
|
|
|
- // NaN
|
|
|
- return BitConverter.Int64BitsToDouble((long)(x_bits | 0x0008000000000000));
|
|
|
- }
|
|
|
-
|
|
|
- if (x_exp == 0)
|
|
|
+ byte[] Table = new byte[512];
|
|
|
+ for (ulong index = 128; index < 512; index++)
|
|
|
{
|
|
|
- if (scaled == 0)
|
|
|
+ ulong a = index;
|
|
|
+ if (a < 256)
|
|
|
{
|
|
|
- // Zero -> Infinity
|
|
|
- return BitConverter.Int64BitsToDouble((long)(x_sign | 0x7FF0000000000000));
|
|
|
+ a = (a << 1) + 1;
|
|
|
}
|
|
|
-
|
|
|
- // Denormal
|
|
|
- while ((scaled & (1 << 51)) == 0)
|
|
|
+ else
|
|
|
{
|
|
|
- scaled <<= 1;
|
|
|
- x_exp--;
|
|
|
+ a = (a | 1) << 1;
|
|
|
}
|
|
|
- scaled <<= 1;
|
|
|
- }
|
|
|
-
|
|
|
- if (x_sign != 0)
|
|
|
- {
|
|
|
- // Negative -> NaN
|
|
|
- return BitConverter.Int64BitsToDouble((long)0x7FF8000000000000);
|
|
|
- }
|
|
|
|
|
|
- if (x_exp == 0x7ff && scaled == 0)
|
|
|
- {
|
|
|
- // Infinity -> Zero
|
|
|
- return BitConverter.Int64BitsToDouble((long)x_sign);
|
|
|
- }
|
|
|
+ ulong b = 256;
|
|
|
+ while (a * (b + 1) * (b + 1) < (1ul << 28))
|
|
|
+ {
|
|
|
+ b++;
|
|
|
+ }
|
|
|
+ b = (b + 1) >> 1;
|
|
|
|
|
|
- if (((ulong)x_exp & 1) == 1)
|
|
|
- {
|
|
|
- scaled >>= 45;
|
|
|
- scaled &= 0xFF;
|
|
|
- scaled |= 0x80;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- scaled >>= 44;
|
|
|
- scaled &= 0xFF;
|
|
|
- scaled |= 0x100;
|
|
|
+ Table[index] = (byte)(b & 0xFF);
|
|
|
}
|
|
|
-
|
|
|
- ulong result_exp = ((ulong)(3068 - x_exp) / 2) & 0x7FF;
|
|
|
- ulong estimate = (ulong)InvSqrtEstimateTable[scaled];
|
|
|
- ulong fraction = estimate << 44;
|
|
|
-
|
|
|
- ulong result = x_sign | (result_exp << 52) | fraction;
|
|
|
- return BitConverter.Int64BitsToDouble((long)result);
|
|
|
+ return Table;
|
|
|
}
|
|
|
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
public static float RecipEstimate(float x)
|
|
|
{
|
|
|
return (float)RecipEstimate((double)x);
|
|
|
@@ -191,39 +127,73 @@ namespace ChocolArm64.Instruction
|
|
|
return BitConverter.Int64BitsToDouble((long)result);
|
|
|
}
|
|
|
|
|
|
- public static float RecipStep(float op1, float op2)
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ public static float InvSqrtEstimate(float x)
|
|
|
{
|
|
|
- return (float)RecipStep((double)op1, (double)op2);
|
|
|
+ return (float)InvSqrtEstimate((double)x);
|
|
|
}
|
|
|
|
|
|
- public static double RecipStep(double op1, double op2)
|
|
|
+ public static double InvSqrtEstimate(double x)
|
|
|
{
|
|
|
- op1 = -op1;
|
|
|
+ ulong x_bits = (ulong)BitConverter.DoubleToInt64Bits(x);
|
|
|
+ ulong x_sign = x_bits & 0x8000000000000000;
|
|
|
+ long x_exp = (long)((x_bits >> 52) & 0x7FF);
|
|
|
+ ulong scaled = x_bits & ((1ul << 52) - 1);
|
|
|
+
|
|
|
+ if (x_exp == 0x7FF && scaled != 0)
|
|
|
+ {
|
|
|
+ // NaN
|
|
|
+ return BitConverter.Int64BitsToDouble((long)(x_bits | 0x0008000000000000));
|
|
|
+ }
|
|
|
+
|
|
|
+ if (x_exp == 0)
|
|
|
+ {
|
|
|
+ if (scaled == 0)
|
|
|
+ {
|
|
|
+ // Zero -> Infinity
|
|
|
+ return BitConverter.Int64BitsToDouble((long)(x_sign | 0x7FF0000000000000));
|
|
|
+ }
|
|
|
|
|
|
- ulong op1_bits = (ulong)BitConverter.DoubleToInt64Bits(op1);
|
|
|
- ulong op2_bits = (ulong)BitConverter.DoubleToInt64Bits(op2);
|
|
|
+ // Denormal
|
|
|
+ while ((scaled & (1 << 51)) == 0)
|
|
|
+ {
|
|
|
+ scaled <<= 1;
|
|
|
+ x_exp--;
|
|
|
+ }
|
|
|
+ scaled <<= 1;
|
|
|
+ }
|
|
|
|
|
|
- ulong op1_sign = op1_bits & 0x8000000000000000;
|
|
|
- ulong op2_sign = op2_bits & 0x8000000000000000;
|
|
|
- ulong op1_other = op1_bits & 0x7FFFFFFFFFFFFFFF;
|
|
|
- ulong op2_other = op2_bits & 0x7FFFFFFFFFFFFFFF;
|
|
|
+ if (x_sign != 0)
|
|
|
+ {
|
|
|
+ // Negative -> NaN
|
|
|
+ return BitConverter.Int64BitsToDouble((long)0x7FF8000000000000);
|
|
|
+ }
|
|
|
|
|
|
- bool inf1 = op1_other == 0x7FF0000000000000;
|
|
|
- bool inf2 = op2_other == 0x7FF0000000000000;
|
|
|
- bool zero1 = op1_other == 0;
|
|
|
- bool zero2 = op2_other == 0;
|
|
|
+ if (x_exp == 0x7ff && scaled == 0)
|
|
|
+ {
|
|
|
+ // Infinity -> Zero
|
|
|
+ return BitConverter.Int64BitsToDouble((long)x_sign);
|
|
|
+ }
|
|
|
|
|
|
- if ((inf1 && zero2) || (zero1 && inf2))
|
|
|
+ if (((ulong)x_exp & 1) == 1)
|
|
|
{
|
|
|
- return 2.0;
|
|
|
+ scaled >>= 45;
|
|
|
+ scaled &= 0xFF;
|
|
|
+ scaled |= 0x80;
|
|
|
}
|
|
|
- else if (inf1 || inf2)
|
|
|
+ else
|
|
|
{
|
|
|
- // Infinity
|
|
|
- return BitConverter.Int64BitsToDouble((long)(0x7FF0000000000000 | (op1_sign ^ op2_sign)));
|
|
|
+ scaled >>= 44;
|
|
|
+ scaled &= 0xFF;
|
|
|
+ scaled |= 0x100;
|
|
|
}
|
|
|
|
|
|
- return 2.0 + op1 * op2;
|
|
|
+ ulong result_exp = ((ulong)(3068 - x_exp) / 2) & 0x7FF;
|
|
|
+ ulong estimate = (ulong)InvSqrtEstimateTable[scaled];
|
|
|
+ ulong fraction = estimate << 44;
|
|
|
+
|
|
|
+ ulong result = x_sign | (result_exp << 52) | fraction;
|
|
|
+ return BitConverter.Int64BitsToDouble((long)result);
|
|
|
}
|
|
|
|
|
|
public static float ConvertHalfToSingle(ushort x)
|
|
|
@@ -261,277 +231,1457 @@ namespace ChocolArm64.Instruction
|
|
|
uint new_exp = (uint)((exponent + 127) & 0xFF) << 23;
|
|
|
return BitConverter.Int32BitsToSingle((int)((x_sign << 31) | new_exp | (x_mantissa << 13)));
|
|
|
}
|
|
|
+ }
|
|
|
|
|
|
- public static float MaxNum(float op1, float op2)
|
|
|
+ static class ASoftFloat_32
|
|
|
+ {
|
|
|
+ public static float FPAdd(float Value1, float Value2, AThreadState State)
|
|
|
{
|
|
|
- uint op1_bits = (uint)BitConverter.SingleToInt32Bits(op1);
|
|
|
- uint op2_bits = (uint)BitConverter.SingleToInt32Bits(op2);
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPAdd: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
|
|
|
- if (IsQNaN(op1_bits) && !IsQNaN(op2_bits))
|
|
|
- {
|
|
|
- op1 = float.NegativeInfinity;
|
|
|
- }
|
|
|
- else if (!IsQNaN(op1_bits) && IsQNaN(op2_bits))
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
+
|
|
|
+ float Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
{
|
|
|
- op2 = float.NegativeInfinity;
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if (Inf1 && Inf2 && Sign1 == !Sign2)
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if ((Inf1 && !Sign1) || (Inf2 && !Sign2))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(false);
|
|
|
+ }
|
|
|
+ else if ((Inf1 && Sign1) || (Inf2 && Sign2))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(true);
|
|
|
+ }
|
|
|
+ else if (Zero1 && Zero2 && Sign1 == Sign2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 + Value2;
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- return Max(op1, op2);
|
|
|
+ return Result;
|
|
|
}
|
|
|
|
|
|
- public static double MaxNum(double op1, double op2)
|
|
|
+ public static float FPDiv(float Value1, float Value2, AThreadState State)
|
|
|
{
|
|
|
- ulong op1_bits = (ulong)BitConverter.DoubleToInt64Bits(op1);
|
|
|
- ulong op2_bits = (ulong)BitConverter.DoubleToInt64Bits(op2);
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPDiv: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
|
|
|
- if (IsQNaN(op1_bits) && !IsQNaN(op2_bits))
|
|
|
- {
|
|
|
- op1 = double.NegativeInfinity;
|
|
|
- }
|
|
|
- else if (!IsQNaN(op1_bits) && IsQNaN(op2_bits))
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
+
|
|
|
+ float Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
{
|
|
|
- op2 = double.NegativeInfinity;
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if ((Inf1 && Inf2) || (Zero1 && Zero2))
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Zero2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+
|
|
|
+ if (!Inf1) FPProcessException(FPExc.DivideByZero, State);
|
|
|
+ }
|
|
|
+ else if (Zero1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 / Value2;
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- return Max(op1, op2);
|
|
|
+ return Result;
|
|
|
}
|
|
|
|
|
|
- public static float Max(float op1, float op2)
|
|
|
+ public static float FPMax(float Value1, float Value2, AThreadState State)
|
|
|
{
|
|
|
- // Fast path
|
|
|
- if (op1 > op2)
|
|
|
- {
|
|
|
- return op1;
|
|
|
- }
|
|
|
-
|
|
|
- if (op1 < op2 || (op1 == op2 && op2 != 0))
|
|
|
- {
|
|
|
- return op2;
|
|
|
- }
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPMax: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
|
|
|
- uint op1_bits = (uint)BitConverter.SingleToInt32Bits(op1);
|
|
|
- uint op2_bits = (uint)BitConverter.SingleToInt32Bits(op2);
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
|
|
|
- // Handle NaN cases
|
|
|
- if (ProcessNaNs(op1_bits, op2_bits, out uint op_bits))
|
|
|
- {
|
|
|
- return BitConverter.Int32BitsToSingle((int)op_bits);
|
|
|
- }
|
|
|
+ float Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
|
|
|
- // Return the most positive zero
|
|
|
- if ((op1_bits & op2_bits) == 0x80000000u)
|
|
|
+ if (!Done)
|
|
|
{
|
|
|
- return BitConverter.Int32BitsToSingle(int.MinValue);
|
|
|
+ if (Value1 > Value2)
|
|
|
+ {
|
|
|
+ if (Type1 == FPType.Infinity)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1);
|
|
|
+ }
|
|
|
+ else if (Type1 == FPType.Zero)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 && Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (Type2 == FPType.Infinity)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign2);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.Zero)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 && Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- return 0;
|
|
|
+ return Result;
|
|
|
}
|
|
|
|
|
|
- public static double Max(double op1, double op2)
|
|
|
+ public static float FPMaxNum(float Value1, float Value2, AThreadState State)
|
|
|
{
|
|
|
- // Fast path
|
|
|
- if (op1 > op2)
|
|
|
- {
|
|
|
- return op1;
|
|
|
- }
|
|
|
-
|
|
|
- if (op1 < op2 || (op1 == op2 && op2 != 0))
|
|
|
- {
|
|
|
- return op2;
|
|
|
- }
|
|
|
+ Debug.WriteIf(State.Fpcr != 0, "ASoftFloat_32.FPMaxNum: ");
|
|
|
|
|
|
- ulong op1_bits = (ulong)BitConverter.DoubleToInt64Bits(op1);
|
|
|
- ulong op2_bits = (ulong)BitConverter.DoubleToInt64Bits(op2);
|
|
|
+ Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
|
|
|
- // Handle NaN cases
|
|
|
- if (ProcessNaNs(op1_bits, op2_bits, out ulong op_bits))
|
|
|
+ if (Type1 == FPType.QNaN && Type2 != FPType.QNaN)
|
|
|
{
|
|
|
- return BitConverter.Int64BitsToDouble((long)op_bits);
|
|
|
+ Value1 = FPInfinity(true);
|
|
|
}
|
|
|
-
|
|
|
- // Return the most positive zero
|
|
|
- if ((op1_bits & op2_bits) == 0x8000000000000000ul)
|
|
|
+ else if (Type1 != FPType.QNaN && Type2 == FPType.QNaN)
|
|
|
{
|
|
|
- return BitConverter.Int64BitsToDouble(long.MinValue);
|
|
|
+ Value2 = FPInfinity(true);
|
|
|
}
|
|
|
|
|
|
- return 0;
|
|
|
+ return FPMax(Value1, Value2, State);
|
|
|
}
|
|
|
|
|
|
- public static float MinNum(float op1, float op2)
|
|
|
+ public static float FPMin(float Value1, float Value2, AThreadState State)
|
|
|
{
|
|
|
- uint op1_bits = (uint)BitConverter.SingleToInt32Bits(op1);
|
|
|
- uint op2_bits = (uint)BitConverter.SingleToInt32Bits(op2);
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPMin: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
|
|
|
- if (IsQNaN(op1_bits) && !IsQNaN(op2_bits))
|
|
|
- {
|
|
|
- op1 = float.PositiveInfinity;
|
|
|
- }
|
|
|
- else if (!IsQNaN(op1_bits) && IsQNaN(op2_bits))
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
+
|
|
|
+ float Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
{
|
|
|
- op2 = float.PositiveInfinity;
|
|
|
+ if (Value1 < Value2)
|
|
|
+ {
|
|
|
+ if (Type1 == FPType.Infinity)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1);
|
|
|
+ }
|
|
|
+ else if (Type1 == FPType.Zero)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 || Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (Type2 == FPType.Infinity)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign2);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.Zero)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 || Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- return Min(op1, op2);
|
|
|
+ return Result;
|
|
|
}
|
|
|
|
|
|
- public static double MinNum(double op1, double op2)
|
|
|
+ public static float FPMinNum(float Value1, float Value2, AThreadState State)
|
|
|
{
|
|
|
- ulong op1_bits = (ulong)BitConverter.DoubleToInt64Bits(op1);
|
|
|
- ulong op2_bits = (ulong)BitConverter.DoubleToInt64Bits(op2);
|
|
|
+ Debug.WriteIf(State.Fpcr != 0, "ASoftFloat_32.FPMinNum: ");
|
|
|
+
|
|
|
+ Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
|
|
|
- if (IsQNaN(op1_bits) && !IsQNaN(op2_bits))
|
|
|
+ if (Type1 == FPType.QNaN && Type2 != FPType.QNaN)
|
|
|
{
|
|
|
- op1 = double.PositiveInfinity;
|
|
|
+ Value1 = FPInfinity(false);
|
|
|
}
|
|
|
- else if (!IsQNaN(op1_bits) && IsQNaN(op2_bits))
|
|
|
+ else if (Type1 != FPType.QNaN && Type2 == FPType.QNaN)
|
|
|
{
|
|
|
- op2 = double.PositiveInfinity;
|
|
|
+ Value2 = FPInfinity(false);
|
|
|
}
|
|
|
|
|
|
- return Min(op1, op2);
|
|
|
+ return FPMin(Value1, Value2, State);
|
|
|
}
|
|
|
|
|
|
- public static float Min(float op1, float op2)
|
|
|
+ public static float FPMul(float Value1, float Value2, AThreadState State)
|
|
|
{
|
|
|
- // Fast path
|
|
|
- if (op1 < op2)
|
|
|
- {
|
|
|
- return op1;
|
|
|
- }
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPMul: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
|
|
|
- if (op1 > op2 || (op1 == op2 && op2 != 0))
|
|
|
- {
|
|
|
- return op2;
|
|
|
- }
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
|
|
|
- uint op1_bits = (uint)BitConverter.SingleToInt32Bits(op1);
|
|
|
- uint op2_bits = (uint)BitConverter.SingleToInt32Bits(op2);
|
|
|
+ float Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
|
|
|
- // Handle NaN cases
|
|
|
- if (ProcessNaNs(op1_bits, op2_bits, out uint op_bits))
|
|
|
+ if (!Done)
|
|
|
{
|
|
|
- return BitConverter.Int32BitsToSingle((int)op_bits);
|
|
|
- }
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
|
|
|
- // Return the most negative zero
|
|
|
- if ((op1_bits | op2_bits) == 0x80000000u)
|
|
|
- {
|
|
|
- return BitConverter.Int32BitsToSingle(int.MinValue);
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2))
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else if (Zero1 || Zero2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 * Value2;
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- return 0;
|
|
|
+ return Result;
|
|
|
}
|
|
|
|
|
|
- public static double Min(double op1, double op2)
|
|
|
+ public static float FPMulAdd(float ValueA, float Value1, float Value2, AThreadState State)
|
|
|
{
|
|
|
- // Fast path
|
|
|
- if (op1 < op2)
|
|
|
- {
|
|
|
- return op1;
|
|
|
- }
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPMulAdd: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
|
|
|
- if (op1 > op2 || (op1 == op2 && op2 != 0))
|
|
|
- {
|
|
|
- return op2;
|
|
|
- }
|
|
|
+ ValueA = ValueA.FPUnpack(out FPType TypeA, out bool SignA, out uint Addend);
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
|
|
|
- ulong op1_bits = (ulong)BitConverter.DoubleToInt64Bits(op1);
|
|
|
- ulong op2_bits = (ulong)BitConverter.DoubleToInt64Bits(op2);
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
|
|
|
- // Handle NaN cases
|
|
|
- if (ProcessNaNs(op1_bits, op2_bits, out ulong op_bits))
|
|
|
+ float Result = FPProcessNaNs3(TypeA, Type1, Type2, Addend, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (TypeA == FPType.QNaN && ((Inf1 && Zero2) || (Zero1 && Inf2)))
|
|
|
{
|
|
|
- return BitConverter.Int64BitsToDouble((long)op_bits);
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
}
|
|
|
|
|
|
- // Return the most negative zero
|
|
|
- if ((op1_bits | op2_bits) == 0x8000000000000000ul)
|
|
|
+ if (!Done)
|
|
|
{
|
|
|
- return BitConverter.Int64BitsToDouble(long.MinValue);
|
|
|
+ bool InfA = TypeA == FPType.Infinity; bool ZeroA = TypeA == FPType.Zero;
|
|
|
+
|
|
|
+ bool SignP = Sign1 ^ Sign2;
|
|
|
+ bool InfP = Inf1 || Inf2;
|
|
|
+ bool ZeroP = Zero1 || Zero2;
|
|
|
+
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2) || (InfA && InfP && SignA != SignP))
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if ((InfA && !SignA) || (InfP && !SignP))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(false);
|
|
|
+ }
|
|
|
+ else if ((InfA && SignA) || (InfP && SignP))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(true);
|
|
|
+ }
|
|
|
+ else if (ZeroA && ZeroP && SignA == SignP)
|
|
|
+ {
|
|
|
+ Result = FPZero(SignA);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ // TODO: When available, use: T MathF.FusedMultiplyAdd(T, T, T);
|
|
|
+ // https://github.com/dotnet/corefx/issues/31903
|
|
|
+
|
|
|
+ Result = ValueA + (Value1 * Value2);
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- return 0;
|
|
|
+ return Result;
|
|
|
}
|
|
|
|
|
|
- private static bool ProcessNaNs(uint op1_bits, uint op2_bits, out uint op_bits)
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ public static float FPMulSub(float ValueA, float Value1, float Value2, AThreadState State)
|
|
|
{
|
|
|
- if (IsSNaN(op1_bits))
|
|
|
- {
|
|
|
- op_bits = op1_bits | (1u << 22); // op1 is SNaN, return QNaN op1
|
|
|
- }
|
|
|
- else if (IsSNaN(op2_bits))
|
|
|
- {
|
|
|
- op_bits = op2_bits | (1u << 22); // op2 is SNaN, return QNaN op2
|
|
|
+ Debug.WriteIf(State.Fpcr != 0, "ASoftFloat_32.FPMulSub: ");
|
|
|
+
|
|
|
+ Value1 = Value1.FPNeg();
|
|
|
+
|
|
|
+ return FPMulAdd(ValueA, Value1, Value2, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ public static float FPMulX(float Value1, float Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPMulX: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
+
|
|
|
+ float Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2))
|
|
|
+ {
|
|
|
+ Result = FPTwo(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else if (Zero1 || Zero2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 * Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static float FPRecipStepFused(float Value1, float Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPRecipStepFused: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPNeg();
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
+
|
|
|
+ float Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2))
|
|
|
+ {
|
|
|
+ Result = FPTwo(false);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ // TODO: When available, use: T MathF.FusedMultiplyAdd(T, T, T);
|
|
|
+ // https://github.com/dotnet/corefx/issues/31903
|
|
|
+
|
|
|
+ Result = 2f + (Value1 * Value2);
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static float FPRecpX(float Value, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPRecpX: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value.FPUnpack(out FPType Type, out bool Sign, out uint Op);
|
|
|
+
|
|
|
+ float Result;
|
|
|
+
|
|
|
+ if (Type == FPType.SNaN || Type == FPType.QNaN)
|
|
|
+ {
|
|
|
+ Result = FPProcessNaN(Type, Op, State);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ uint NotExp = (~Op >> 23) & 0xFFu;
|
|
|
+ uint MaxExp = 0xFEu;
|
|
|
+
|
|
|
+ Result = BitConverter.Int32BitsToSingle(
|
|
|
+ (int)((Sign ? 1u : 0u) << 31 | (NotExp == 0xFFu ? MaxExp : NotExp) << 23));
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static float FPRSqrtStepFused(float Value1, float Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPRSqrtStepFused: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPNeg();
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
+
|
|
|
+ float Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2))
|
|
|
+ {
|
|
|
+ Result = FPOnePointFive(false);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ // TODO: When available, use: T MathF.FusedMultiplyAdd(T, T, T);
|
|
|
+ // https://github.com/dotnet/corefx/issues/31903
|
|
|
+
|
|
|
+ Result = (3f + (Value1 * Value2)) / 2f;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static float FPSqrt(float Value, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPSqrt: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value = Value.FPUnpack(out FPType Type, out bool Sign, out uint Op);
|
|
|
+
|
|
|
+ float Result;
|
|
|
+
|
|
|
+ if (Type == FPType.SNaN || Type == FPType.QNaN)
|
|
|
+ {
|
|
|
+ Result = FPProcessNaN(Type, Op, State);
|
|
|
+ }
|
|
|
+ else if (Type == FPType.Zero)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign);
|
|
|
+ }
|
|
|
+ else if (Type == FPType.Infinity && !Sign)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign);
|
|
|
+ }
|
|
|
+ else if (Sign)
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = MathF.Sqrt(Value);
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static float FPSub(float Value1, float Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_32.FPSub: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out uint Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out uint Op2);
|
|
|
+
|
|
|
+ float Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if (Inf1 && Inf2 && Sign1 == Sign2)
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if ((Inf1 && !Sign1) || (Inf2 && Sign2))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(false);
|
|
|
+ }
|
|
|
+ else if ((Inf1 && Sign1) || (Inf2 && !Sign2))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(true);
|
|
|
+ }
|
|
|
+ else if (Zero1 && Zero2 && Sign1 == !Sign2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 - Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ private enum FPType
|
|
|
+ {
|
|
|
+ Nonzero,
|
|
|
+ Zero,
|
|
|
+ Infinity,
|
|
|
+ QNaN,
|
|
|
+ SNaN
|
|
|
+ }
|
|
|
+
|
|
|
+ private enum FPExc
|
|
|
+ {
|
|
|
+ InvalidOp,
|
|
|
+ DivideByZero,
|
|
|
+ Overflow,
|
|
|
+ Underflow,
|
|
|
+ Inexact,
|
|
|
+ InputDenorm = 7
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static float FPDefaultNaN()
|
|
|
+ {
|
|
|
+ return -float.NaN;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static float FPInfinity(bool Sign)
|
|
|
+ {
|
|
|
+ return Sign ? float.NegativeInfinity : float.PositiveInfinity;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static float FPZero(bool Sign)
|
|
|
+ {
|
|
|
+ return Sign ? -0f : +0f;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static float FPTwo(bool Sign)
|
|
|
+ {
|
|
|
+ return Sign ? -2f : +2f;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static float FPOnePointFive(bool Sign)
|
|
|
+ {
|
|
|
+ return Sign ? -1.5f : +1.5f;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static float FPNeg(this float Value)
|
|
|
+ {
|
|
|
+ return -Value;
|
|
|
+ }
|
|
|
+
|
|
|
+ private static float FPUnpack(this float Value, out FPType Type, out bool Sign, out uint ValueBits)
|
|
|
+ {
|
|
|
+ ValueBits = (uint)BitConverter.SingleToInt32Bits(Value);
|
|
|
+
|
|
|
+ Sign = (~ValueBits & 0x80000000u) == 0u;
|
|
|
+
|
|
|
+ if ((ValueBits & 0x7F800000u) == 0u)
|
|
|
+ {
|
|
|
+ if ((ValueBits & 0x007FFFFFu) == 0u)
|
|
|
+ {
|
|
|
+ Type = FPType.Zero;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Type = FPType.Nonzero;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if ((~ValueBits & 0x7F800000u) == 0u)
|
|
|
+ {
|
|
|
+ if ((ValueBits & 0x007FFFFFu) == 0u)
|
|
|
+ {
|
|
|
+ Type = FPType.Infinity;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Type = (~ValueBits & 0x00400000u) == 0u
|
|
|
+ ? FPType.QNaN
|
|
|
+ : FPType.SNaN;
|
|
|
+
|
|
|
+ return FPZero(Sign);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Type = FPType.Nonzero;
|
|
|
+ }
|
|
|
+
|
|
|
+ return Value;
|
|
|
+ }
|
|
|
+
|
|
|
+ private static float FPProcessNaNs(
|
|
|
+ FPType Type1,
|
|
|
+ FPType Type2,
|
|
|
+ uint Op1,
|
|
|
+ uint Op2,
|
|
|
+ AThreadState State,
|
|
|
+ out bool Done)
|
|
|
+ {
|
|
|
+ Done = true;
|
|
|
+
|
|
|
+ if (Type1 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type1, Op1, State);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type2, Op2, State);
|
|
|
+ }
|
|
|
+ else if (Type1 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type1, Op1, State);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type2, Op2, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ Done = false;
|
|
|
+
|
|
|
+ return FPZero(false);
|
|
|
+ }
|
|
|
+
|
|
|
+ private static float FPProcessNaNs3(
|
|
|
+ FPType Type1,
|
|
|
+ FPType Type2,
|
|
|
+ FPType Type3,
|
|
|
+ uint Op1,
|
|
|
+ uint Op2,
|
|
|
+ uint Op3,
|
|
|
+ AThreadState State,
|
|
|
+ out bool Done)
|
|
|
+ {
|
|
|
+ Done = true;
|
|
|
+
|
|
|
+ if (Type1 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type1, Op1, State);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type2, Op2, State);
|
|
|
+ }
|
|
|
+ else if (Type3 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type3, Op3, State);
|
|
|
+ }
|
|
|
+ else if (Type1 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type1, Op1, State);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type2, Op2, State);
|
|
|
+ }
|
|
|
+ else if (Type3 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type3, Op3, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ Done = false;
|
|
|
+
|
|
|
+ return FPZero(false);
|
|
|
+ }
|
|
|
+
|
|
|
+ private static float FPProcessNaN(FPType Type, uint Op, AThreadState State)
|
|
|
+ {
|
|
|
+ const int DNBit = 25; // Default NaN mode control bit.
|
|
|
+
|
|
|
+ if (Type == FPType.SNaN)
|
|
|
+ {
|
|
|
+ Op |= 1u << 22;
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((State.Fpcr & (1 << DNBit)) != 0)
|
|
|
+ {
|
|
|
+ return FPDefaultNaN();
|
|
|
+ }
|
|
|
+
|
|
|
+ return BitConverter.Int32BitsToSingle((int)Op);
|
|
|
+ }
|
|
|
+
|
|
|
+ private static void FPProcessException(FPExc Exc, AThreadState State)
|
|
|
+ {
|
|
|
+ int Enable = (int)Exc + 8;
|
|
|
+
|
|
|
+ if ((State.Fpcr & (1 << Enable)) != 0)
|
|
|
+ {
|
|
|
+ throw new NotImplementedException("floating-point trap handling");
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ State.Fpsr |= 1 << (int)Exc;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ static class ASoftFloat_64
|
|
|
+ {
|
|
|
+ public static double FPAdd(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPAdd: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if (Inf1 && Inf2 && Sign1 == !Sign2)
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if ((Inf1 && !Sign1) || (Inf2 && !Sign2))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(false);
|
|
|
+ }
|
|
|
+ else if ((Inf1 && Sign1) || (Inf2 && Sign2))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(true);
|
|
|
+ }
|
|
|
+ else if (Zero1 && Zero2 && Sign1 == Sign2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 + Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPDiv(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPDiv: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if ((Inf1 && Inf2) || (Zero1 && Zero2))
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Zero2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+
|
|
|
+ if (!Inf1) FPProcessException(FPExc.DivideByZero, State);
|
|
|
+ }
|
|
|
+ else if (Zero1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 / Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPMax(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPMax: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ if (Value1 > Value2)
|
|
|
+ {
|
|
|
+ if (Type1 == FPType.Infinity)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1);
|
|
|
+ }
|
|
|
+ else if (Type1 == FPType.Zero)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 && Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (Type2 == FPType.Infinity)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign2);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.Zero)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 && Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPMaxNum(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteIf(State.Fpcr != 0, "ASoftFloat_64.FPMaxNum: ");
|
|
|
+
|
|
|
+ Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ if (Type1 == FPType.QNaN && Type2 != FPType.QNaN)
|
|
|
+ {
|
|
|
+ Value1 = FPInfinity(true);
|
|
|
+ }
|
|
|
+ else if (Type1 != FPType.QNaN && Type2 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ Value2 = FPInfinity(true);
|
|
|
+ }
|
|
|
+
|
|
|
+ return FPMax(Value1, Value2, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPMin(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPMin: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ if (Value1 < Value2)
|
|
|
+ {
|
|
|
+ if (Type1 == FPType.Infinity)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1);
|
|
|
+ }
|
|
|
+ else if (Type1 == FPType.Zero)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 || Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ if (Type2 == FPType.Infinity)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign2);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.Zero)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 || Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPMinNum(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteIf(State.Fpcr != 0, "ASoftFloat_64.FPMinNum: ");
|
|
|
+
|
|
|
+ Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ if (Type1 == FPType.QNaN && Type2 != FPType.QNaN)
|
|
|
+ {
|
|
|
+ Value1 = FPInfinity(false);
|
|
|
+ }
|
|
|
+ else if (Type1 != FPType.QNaN && Type2 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ Value2 = FPInfinity(false);
|
|
|
+ }
|
|
|
+
|
|
|
+ return FPMin(Value1, Value2, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPMul(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPMul: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2))
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else if (Zero1 || Zero2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 * Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPMulAdd(double ValueA, double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPMulAdd: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ ValueA = ValueA.FPUnpack(out FPType TypeA, out bool SignA, out ulong Addend);
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs3(TypeA, Type1, Type2, Addend, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (TypeA == FPType.QNaN && ((Inf1 && Zero2) || (Zero1 && Inf2)))
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool InfA = TypeA == FPType.Infinity; bool ZeroA = TypeA == FPType.Zero;
|
|
|
+
|
|
|
+ bool SignP = Sign1 ^ Sign2;
|
|
|
+ bool InfP = Inf1 || Inf2;
|
|
|
+ bool ZeroP = Zero1 || Zero2;
|
|
|
+
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2) || (InfA && InfP && SignA != SignP))
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if ((InfA && !SignA) || (InfP && !SignP))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(false);
|
|
|
+ }
|
|
|
+ else if ((InfA && SignA) || (InfP && SignP))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(true);
|
|
|
+ }
|
|
|
+ else if (ZeroA && ZeroP && SignA == SignP)
|
|
|
+ {
|
|
|
+ Result = FPZero(SignA);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ // TODO: When available, use: T Math.FusedMultiplyAdd(T, T, T);
|
|
|
+ // https://github.com/dotnet/corefx/issues/31903
|
|
|
+
|
|
|
+ Result = ValueA + (Value1 * Value2);
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ public static double FPMulSub(double ValueA, double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteIf(State.Fpcr != 0, "ASoftFloat_64.FPMulSub: ");
|
|
|
+
|
|
|
+ Value1 = Value1.FPNeg();
|
|
|
+
|
|
|
+ return FPMulAdd(ValueA, Value1, Value2, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPMulX(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPMulX: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2))
|
|
|
+ {
|
|
|
+ Result = FPTwo(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else if (Zero1 || Zero2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 * Value2;
|
|
|
+ }
|
|
|
}
|
|
|
- else if (IsQNaN(op1_bits))
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPRecipStepFused(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPRecipStepFused: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPNeg();
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
{
|
|
|
- op_bits = op1_bits; // op1 is QNaN, return QNaN op1
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2))
|
|
|
+ {
|
|
|
+ Result = FPTwo(false);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ // TODO: When available, use: T Math.FusedMultiplyAdd(T, T, T);
|
|
|
+ // https://github.com/dotnet/corefx/issues/31903
|
|
|
+
|
|
|
+ Result = 2d + (Value1 * Value2);
|
|
|
+ }
|
|
|
}
|
|
|
- else if (IsQNaN(op2_bits))
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPRecpX(double Value, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPRecpX: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value.FPUnpack(out FPType Type, out bool Sign, out ulong Op);
|
|
|
+
|
|
|
+ double Result;
|
|
|
+
|
|
|
+ if (Type == FPType.SNaN || Type == FPType.QNaN)
|
|
|
{
|
|
|
- op_bits = op2_bits; // op2 is QNaN, return QNaN op2
|
|
|
+ Result = FPProcessNaN(Type, Op, State);
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- op_bits = 0;
|
|
|
+ ulong NotExp = (~Op >> 52) & 0x7FFul;
|
|
|
+ ulong MaxExp = 0x7FEul;
|
|
|
+
|
|
|
+ Result = BitConverter.Int64BitsToDouble(
|
|
|
+ (long)((Sign ? 1ul : 0ul) << 63 | (NotExp == 0x7FFul ? MaxExp : NotExp) << 52));
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPRSqrtStepFused(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPRSqrtStepFused: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPNeg();
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if ((Inf1 && Zero2) || (Zero1 && Inf2))
|
|
|
+ {
|
|
|
+ Result = FPOnePointFive(false);
|
|
|
+ }
|
|
|
+ else if (Inf1 || Inf2)
|
|
|
+ {
|
|
|
+ Result = FPInfinity(Sign1 ^ Sign2);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ // TODO: When available, use: T Math.FusedMultiplyAdd(T, T, T);
|
|
|
+ // https://github.com/dotnet/corefx/issues/31903
|
|
|
|
|
|
- return false;
|
|
|
+ Result = (3d + (Value1 * Value2)) / 2d;
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
- return true;
|
|
|
+ return Result;
|
|
|
}
|
|
|
|
|
|
- private static bool ProcessNaNs(ulong op1_bits, ulong op2_bits, out ulong op_bits)
|
|
|
+ public static double FPSqrt(double Value, AThreadState State)
|
|
|
{
|
|
|
- if (IsSNaN(op1_bits))
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPSqrt: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value = Value.FPUnpack(out FPType Type, out bool Sign, out ulong Op);
|
|
|
+
|
|
|
+ double Result;
|
|
|
+
|
|
|
+ if (Type == FPType.SNaN || Type == FPType.QNaN)
|
|
|
{
|
|
|
- op_bits = op1_bits | (1ul << 51); // op1 is SNaN, return QNaN op1
|
|
|
+ Result = FPProcessNaN(Type, Op, State);
|
|
|
}
|
|
|
- else if (IsSNaN(op2_bits))
|
|
|
+ else if (Type == FPType.Zero)
|
|
|
{
|
|
|
- op_bits = op2_bits | (1ul << 51); // op2 is SNaN, return QNaN op2
|
|
|
+ Result = FPZero(Sign);
|
|
|
}
|
|
|
- else if (IsQNaN(op1_bits))
|
|
|
+ else if (Type == FPType.Infinity && !Sign)
|
|
|
{
|
|
|
- op_bits = op1_bits; // op1 is QNaN, return QNaN op1
|
|
|
+ Result = FPInfinity(Sign);
|
|
|
}
|
|
|
- else if (IsQNaN(op2_bits))
|
|
|
+ else if (Sign)
|
|
|
{
|
|
|
- op_bits = op2_bits; // op2 is QNaN, return QNaN op2
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- op_bits = 0;
|
|
|
+ Result = Math.Sqrt(Value);
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ public static double FPSub(double Value1, double Value2, AThreadState State)
|
|
|
+ {
|
|
|
+ Debug.WriteLineIf(State.Fpcr != 0, $"ASoftFloat_64.FPSub: State.Fpcr = 0x{State.Fpcr:X8}");
|
|
|
+
|
|
|
+ Value1 = Value1.FPUnpack(out FPType Type1, out bool Sign1, out ulong Op1);
|
|
|
+ Value2 = Value2.FPUnpack(out FPType Type2, out bool Sign2, out ulong Op2);
|
|
|
+
|
|
|
+ double Result = FPProcessNaNs(Type1, Type2, Op1, Op2, State, out bool Done);
|
|
|
+
|
|
|
+ if (!Done)
|
|
|
+ {
|
|
|
+ bool Inf1 = Type1 == FPType.Infinity; bool Zero1 = Type1 == FPType.Zero;
|
|
|
+ bool Inf2 = Type2 == FPType.Infinity; bool Zero2 = Type2 == FPType.Zero;
|
|
|
+
|
|
|
+ if (Inf1 && Inf2 && Sign1 == Sign2)
|
|
|
+ {
|
|
|
+ Result = FPDefaultNaN();
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+ else if ((Inf1 && !Sign1) || (Inf2 && Sign2))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(false);
|
|
|
+ }
|
|
|
+ else if ((Inf1 && Sign1) || (Inf2 && !Sign2))
|
|
|
+ {
|
|
|
+ Result = FPInfinity(true);
|
|
|
+ }
|
|
|
+ else if (Zero1 && Zero2 && Sign1 == !Sign2)
|
|
|
+ {
|
|
|
+ Result = FPZero(Sign1);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Result = Value1 - Value2;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return Result;
|
|
|
+ }
|
|
|
+
|
|
|
+ private enum FPType
|
|
|
+ {
|
|
|
+ Nonzero,
|
|
|
+ Zero,
|
|
|
+ Infinity,
|
|
|
+ QNaN,
|
|
|
+ SNaN
|
|
|
+ }
|
|
|
+
|
|
|
+ private enum FPExc
|
|
|
+ {
|
|
|
+ InvalidOp,
|
|
|
+ DivideByZero,
|
|
|
+ Overflow,
|
|
|
+ Underflow,
|
|
|
+ Inexact,
|
|
|
+ InputDenorm = 7
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static double FPDefaultNaN()
|
|
|
+ {
|
|
|
+ return -double.NaN;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static double FPInfinity(bool Sign)
|
|
|
+ {
|
|
|
+ return Sign ? double.NegativeInfinity : double.PositiveInfinity;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static double FPZero(bool Sign)
|
|
|
+ {
|
|
|
+ return Sign ? -0d : +0d;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static double FPTwo(bool Sign)
|
|
|
+ {
|
|
|
+ return Sign ? -2d : +2d;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static double FPOnePointFive(bool Sign)
|
|
|
+ {
|
|
|
+ return Sign ? -1.5d : +1.5d;
|
|
|
+ }
|
|
|
+
|
|
|
+ [MethodImpl(MethodImplOptions.AggressiveInlining)]
|
|
|
+ private static double FPNeg(this double Value)
|
|
|
+ {
|
|
|
+ return -Value;
|
|
|
+ }
|
|
|
+
|
|
|
+ private static double FPUnpack(this double Value, out FPType Type, out bool Sign, out ulong ValueBits)
|
|
|
+ {
|
|
|
+ ValueBits = (ulong)BitConverter.DoubleToInt64Bits(Value);
|
|
|
+
|
|
|
+ Sign = (~ValueBits & 0x8000000000000000ul) == 0ul;
|
|
|
+
|
|
|
+ if ((ValueBits & 0x7FF0000000000000ul) == 0ul)
|
|
|
+ {
|
|
|
+ if ((ValueBits & 0x000FFFFFFFFFFFFFul) == 0ul)
|
|
|
+ {
|
|
|
+ Type = FPType.Zero;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Type = FPType.Nonzero;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else if ((~ValueBits & 0x7FF0000000000000ul) == 0ul)
|
|
|
+ {
|
|
|
+ if ((ValueBits & 0x000FFFFFFFFFFFFFul) == 0ul)
|
|
|
+ {
|
|
|
+ Type = FPType.Infinity;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Type = (~ValueBits & 0x0008000000000000ul) == 0ul
|
|
|
+ ? FPType.QNaN
|
|
|
+ : FPType.SNaN;
|
|
|
|
|
|
- return false;
|
|
|
+ return FPZero(Sign);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ Type = FPType.Nonzero;
|
|
|
}
|
|
|
|
|
|
- return true;
|
|
|
+ return Value;
|
|
|
}
|
|
|
|
|
|
- private static bool IsQNaN(uint op_bits)
|
|
|
+ private static double FPProcessNaNs(
|
|
|
+ FPType Type1,
|
|
|
+ FPType Type2,
|
|
|
+ ulong Op1,
|
|
|
+ ulong Op2,
|
|
|
+ AThreadState State,
|
|
|
+ out bool Done)
|
|
|
{
|
|
|
- return (op_bits & 0x007FFFFF) != 0 &&
|
|
|
- (op_bits & 0x7FC00000) == 0x7FC00000;
|
|
|
+ Done = true;
|
|
|
+
|
|
|
+ if (Type1 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type1, Op1, State);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type2, Op2, State);
|
|
|
+ }
|
|
|
+ else if (Type1 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type1, Op1, State);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type2, Op2, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ Done = false;
|
|
|
+
|
|
|
+ return FPZero(false);
|
|
|
}
|
|
|
|
|
|
- private static bool IsQNaN(ulong op_bits)
|
|
|
+ private static double FPProcessNaNs3(
|
|
|
+ FPType Type1,
|
|
|
+ FPType Type2,
|
|
|
+ FPType Type3,
|
|
|
+ ulong Op1,
|
|
|
+ ulong Op2,
|
|
|
+ ulong Op3,
|
|
|
+ AThreadState State,
|
|
|
+ out bool Done)
|
|
|
{
|
|
|
- return (op_bits & 0x000FFFFFFFFFFFFF) != 0 &&
|
|
|
- (op_bits & 0x7FF8000000000000) == 0x7FF8000000000000;
|
|
|
+ Done = true;
|
|
|
+
|
|
|
+ if (Type1 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type1, Op1, State);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type2, Op2, State);
|
|
|
+ }
|
|
|
+ else if (Type3 == FPType.SNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type3, Op3, State);
|
|
|
+ }
|
|
|
+ else if (Type1 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type1, Op1, State);
|
|
|
+ }
|
|
|
+ else if (Type2 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type2, Op2, State);
|
|
|
+ }
|
|
|
+ else if (Type3 == FPType.QNaN)
|
|
|
+ {
|
|
|
+ return FPProcessNaN(Type3, Op3, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ Done = false;
|
|
|
+
|
|
|
+ return FPZero(false);
|
|
|
}
|
|
|
|
|
|
- private static bool IsSNaN(uint op_bits)
|
|
|
+ private static double FPProcessNaN(FPType Type, ulong Op, AThreadState State)
|
|
|
{
|
|
|
- return (op_bits & 0x007FFFFF) != 0 &&
|
|
|
- (op_bits & 0x7FC00000) == 0x7F800000;
|
|
|
+ const int DNBit = 25; // Default NaN mode control bit.
|
|
|
+
|
|
|
+ if (Type == FPType.SNaN)
|
|
|
+ {
|
|
|
+ Op |= 1ul << 51;
|
|
|
+
|
|
|
+ FPProcessException(FPExc.InvalidOp, State);
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((State.Fpcr & (1 << DNBit)) != 0)
|
|
|
+ {
|
|
|
+ return FPDefaultNaN();
|
|
|
+ }
|
|
|
+
|
|
|
+ return BitConverter.Int64BitsToDouble((long)Op);
|
|
|
}
|
|
|
|
|
|
- private static bool IsSNaN(ulong op_bits)
|
|
|
+ private static void FPProcessException(FPExc Exc, AThreadState State)
|
|
|
{
|
|
|
- return (op_bits & 0x000FFFFFFFFFFFFF) != 0 &&
|
|
|
- (op_bits & 0x7FF8000000000000) == 0x7FF0000000000000;
|
|
|
+ int Enable = (int)Exc + 8;
|
|
|
+
|
|
|
+ if ((State.Fpcr & (1 << Enable)) != 0)
|
|
|
+ {
|
|
|
+ throw new NotImplementedException("floating-point trap handling");
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ State.Fpsr |= 1 << (int)Exc;
|
|
|
+ }
|
|
|
}
|
|
|
}
|
|
|
-}
|
|
|
+}
|