public void WristPointingUp()
{
Vector3 elbowToWrist = new Vector3(0, 1, 0);
double angle = InverseKinematics.GetElbowAngle(shoulderToElbow, elbowToWrist);
Assert.AreEqual(-90, angle, angleTolerance);
}
public void Inline()
{
Vector3 elbowToWrist = new Vector3(-1, 0, 0);
double angle = InverseKinematics.GetElbowAngle(shoulderToElbow, elbowToWrist);
Assert.AreEqual(0, angle, angleTolerance);
}
