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); }