Changed resolveRotationAmbiguity.m to check for the angle + pi always; previously it was only checking if the initial measured rotation angle was greater than some angle. This was an inappropriate constraint.