public static bool ApproxEqual(Euclidean3d r0, Euclidean3d r1, double angleTol, double posTol) { return(V3d.ApproxEqual(r0.Trans, r1.Trans, posTol) && Rot3d.ApproxEqual(r0.Rot, r1.Rot, angleTol)); }