private static bool Same(Vector3 a, Vector3 b, float epsilon) { return Math.Abs(a.X - b.X) < epsilon && Math.Abs(a.Y - b.Y) < epsilon && Math.Abs(a.Z - b.Z) < epsilon; }