public void AddPoint(Point3D point) { Paths.Add(point); }
public static double CalculateDistance(Point3D first, Point3D second) { return Math.Sqrt(((first.X - second.X) * (first.X - second.X)) + ((first.Y - second.Y) * (first.Y - second.Y)) + ((first.Z - second.Z) * (first.Z - second.Z))); }