public void MoveToTest1()
{
var result = RobotMathematics.MoveTo(17, -14, Math.PI / 6);
Assert.AreEqual(2 * Math.PI, result[0] + result[1] + result[2] + Math.PI / 6, 1e-6);
}
public void GetAngleTest3()
{
var result = RobotMathematics.GetAngle(1, 10, 4);
Assert.AreEqual(double.NaN, result);
}
public void GetAngleTest4()
{
var result = RobotMathematics.GetAngle(3, 5, 4);
Assert.AreEqual(Math.Acos(4.0 / 5), result, 1e-6);
}
public void GetAngleTest2()
{
var result = RobotMathematics.GetAngle(5, 3, 4);
Assert.AreEqual(Math.PI / 2, result, 1e-6);
}
