public static double CalcDistance(Point3D first, Point3D second) { return Math.Sqrt( (first.XCoord - second.XCoord) * (first.XCoord - second.XCoord) + (first.YCoord - second.YCoord) * (first.YCoord - second.YCoord) + (first.ZCoord - second.ZCoord) * (first.ZCoord - second.ZCoord)); }
public void AddPoint(Point3D point) { this.trail.Add(point); }