public static double GetDistance3D(Point A, Point B) { double dx = (double)(A.x - B.x); double dy = (double)(A.y - B.y); double dz = (double)(A.z - B.z); double distance = Math.Sqrt(dx * dx + dy * dy + dz * dz); return distance; }