public void WristPointingUp()
{
Point3 wrist = new Point3(10, 11, 9);
double roll = InverseKinematics.GetShoulderRollRight(neckToSpine, shoulderL, shoulderR, elbow, wrist);
Assert.AreEqual(90, roll, angleTolerance);
}
public void Inline()
{
Point3 wrist = new Point3(10, 10, 8);
double roll = InverseKinematics.GetShoulderRollRight(neckToSpine, shoulderL, shoulderR, elbow, wrist);
Assert.AreEqual(0, roll);
}