public void ASinTest()
{
float actual = MathHelper.Round(MathHelper.Asin(1f), 6);
float expected = 1.570796f;
Assert.AreEqual(expected, actual);
}
private static float YawStep(float radius, float pitch)
{
var bigRadius = RadiusAt(radius, pitch + PitchStep(radius));
return(bigRadius > 1
? MinHorizontalDistance * MathHelper.Asin(1f / bigRadius)
: float.PositiveInfinity);
}
public void Asin(double expected, double input)
{
// Act
var actual = MathHelper.Asin(input);
// Assert
Assert.Equal(expected, actual);
}
/// <summary>
/// Calculates the angles and sides.
/// </summary>
/// <param name="data">The data.</param>
/// <remarks>
/// http://cossincalc.com/
/// </remarks>
private static TriangleData CalculateAnglesAndSides(TriangleData data)
{
// A
if (MathHelper.IsEqualToZero(data.A))
{
if (!MathHelper.IsEqualToZero(data.B) && !MathHelper.IsEqualToZero(data.C))
{
data.A = 180 - data.B - data.C;
}
else if (!MathHelper.IsEqualToZero(data.B) && !MathHelper.IsEqualToZero(data.a) && !MathHelper.IsEqualToZero(data.b))
{
data.A = MathHelper.Asin(MathHelper.Sin(data.B) * data.a / data.b);
}
else if (!MathHelper.IsEqualToZero(data.B) && !MathHelper.IsEqualToZero(data.b) && !MathHelper.IsEqualToZero(data.c))
{
if (MathHelper.IsEqualToZero(data.C))
{
data.C = MathHelper.Asin(MathHelper.Sin(data.B) * data.c / data.b);
}
data.A = 180 - data.B - data.C;
}
else if (!MathHelper.IsEqualToZero(data.B) && !MathHelper.IsEqualToZero(data.a) && !MathHelper.IsEqualToZero(data.c))
{
double a2 = data.a * data.a;
double c2 = data.c * data.c;
if (MathHelper.IsEqualToZero(data.b))
{
data.b = System.Math.Sqrt(a2 + c2 - (2 * data.a * data.c * MathHelper.Cos(data.B)));
}
double b2 = data.b * data.b;
data.A = MathHelper.Acos((b2 + c2 - a2) / (2 * data.b * data.c));
}
else if (!MathHelper.IsEqualToZero(data.C) && !MathHelper.IsEqualToZero(data.a) && !MathHelper.IsEqualToZero(data.b))
{
double a2 = data.a * data.a;
double b2 = data.b * data.b;
if (MathHelper.IsEqualToZero(data.c))
{
data.c = System.Math.Sqrt(a2 + b2 - (2 * data.a * data.b * MathHelper.Cos(data.C)));
}
double c2 = data.c * data.c;
data.A = MathHelper.Acos((b2 + c2 - a2) / (2 * data.b * data.c));
}
else if (!MathHelper.IsEqualToZero(data.C) && !MathHelper.IsEqualToZero(data.a) && !MathHelper.IsEqualToZero(data.c))
{
if (MathHelper.IsEqualToZero(data.A))
{
data.A = MathHelper.Asin(MathHelper.Sin(data.C) * data.a / data.c);
}
data.B = 180 - data.A - data.C;
}
else if (!MathHelper.IsEqualToZero(data.C) && !MathHelper.IsEqualToZero(data.b) && !MathHelper.IsEqualToZero(data.c))
{
if (MathHelper.IsEqualToZero(data.B))
{
data.B = MathHelper.Asin(MathHelper.Sin(data.C) * data.b / data.c);
}
data.A = 180 - data.B - data.C;
}
else
{
throw new ArithmeticException("This scenario is not implemented yet.");
}
}
// B
if (MathHelper.IsEqualToZero(data.B))
{
if (!MathHelper.IsEqualToZero(data.A) && !MathHelper.IsEqualToZero(data.C))
{
data.B = 180 - data.A - data.C;
}
else if (!MathHelper.IsEqualToZero(data.A) && !MathHelper.IsEqualToZero(data.a) && !MathHelper.IsEqualToZero(data.b))
{
data.B = MathHelper.Asin(MathHelper.Sin(data.A) * data.b / data.a);
}
else if (!MathHelper.IsEqualToZero(data.A) && !MathHelper.IsEqualToZero(data.b) && !MathHelper.IsEqualToZero(data.c))
{
double b2 = data.b * data.b;
double c2 = data.c * data.c;
if (MathHelper.IsEqualToZero(data.a))
{
data.a = System.Math.Sqrt(b2 + c2 - (2 * data.b * data.c * MathHelper.Cos(data.A)));
}
double a2 = data.a * data.a;
data.B = MathHelper.Acos((a2 + c2 - b2) / (2 * data.a * data.c));
}
else if (!MathHelper.IsEqualToZero(data.A) && !MathHelper.IsEqualToZero(data.a) && !MathHelper.IsEqualToZero(data.c))
{
if (MathHelper.IsEqualToZero(data.C))
{
data.C = MathHelper.Asin(MathHelper.Sin(data.A) * data.c / data.a);
}
data.B = 180 - data.A - data.C;
}
else
{
throw new ArithmeticException("This scenario is not implemented yet.");
}
}
// C
if (MathHelper.IsEqualToZero(data.C))
{
if (!MathHelper.IsEqualToZero(data.A) && !MathHelper.IsEqualToZero(data.B))
{
data.C = 180 - data.A - data.B;
}
else
{
throw new ArithmeticException("This scenario is not implemented yet.");
}
}
// a
if (MathHelper.IsEqualToZero(data.a))
{
if (!MathHelper.IsEqualToZero(data.A) && !MathHelper.IsEqualToZero(data.B) && !MathHelper.IsEqualToZero(data.b))
{
data.a = MathHelper.Sin(data.A) * data.b / MathHelper.Sin(data.B);
}
else if (!MathHelper.IsEqualToZero(data.A) && !MathHelper.IsEqualToZero(data.C) && !MathHelper.IsEqualToZero(data.c))
{
data.a = MathHelper.Sin(data.A) * data.c / MathHelper.Sin(data.C);
}
else
{
throw new ArithmeticException("This scenario is not implemented yet.");
}
}
// b
if (MathHelper.IsEqualToZero(data.b))
{
if (!MathHelper.IsEqualToZero(data.A) && !MathHelper.IsEqualToZero(data.B) && !MathHelper.IsEqualToZero(data.a))
{
data.b = MathHelper.Sin(data.B) * data.a / MathHelper.Sin(data.A);
}
else
{
throw new ArithmeticException("This scenario is not implemented yet.");
}
}
// c
if (MathHelper.IsEqualToZero(data.c))
{
if (!MathHelper.IsEqualToZero(data.A) && !MathHelper.IsEqualToZero(data.C) && !MathHelper.IsEqualToZero(data.a))
{
data.c = MathHelper.Sin(data.C) * data.a / MathHelper.Sin(data.A);
}
else
{
throw new ArithmeticException("This scenario is not implemented yet.");
}
}
return(IsAngleAndSidesCalculated(data)
? data
: CalculateAnglesAndSides(data));
}
private static float PitchStep(float radius) => MinVerticalDistance *MathHelper.Asin(1f / radius);
public static float Asin(float radians) => (float)MathHelper.Asin(radians);
private static float SignedAngleBetween(Vector2 v1, Vector2 v2)
{
return(MathHelper.Asin(Vector2.Cross(v1.Normalize(), v2.Normalize())));
}
