Remove unnecessary check
Implement Vector3d.OrthoNormalize
Rewrite reference frame tests