private static List <PoseError> CompareAngleForBone(BoneType reference, PlaneBasedBodyAngles current, PlaneBasedBodyAngles target, float tolerance)
{
var ret = new List <PoseError>();
foreach (var entry in target.angles[reference])
{
var targetAngle = entry.Value;
var actualAngle = current.GetAngle(reference, entry.Key);
if (!IsAngleWithinInterval(actualAngle, targetAngle, tolerance))
{
//TODO calculate the error margin
float margin = (targetAngle - tolerance);
//mark the pair of bones as an error
var error = new PoseError(target.plane, reference, entry.Key, margin);
ret.Add(error);
}
else
{
//if we need to do something when its right
}
}
return(ret);
}
