static void Main()
 {
     Struct3DPoint point = new Struct3DPoint(2, 1, 5);
     float distance = CalcDistance.Calculate(Struct3DPoint.Basse,point);
     Console.WriteLine(distance);
     List<PathStorage> path = new List<PathStorage>();
     PathStorage firstpath = new PathStorage();
     for (int i = 0; i < 10; i++)
     {
         firstpath.AddPoint(i+0.25f);
     }
 }
 public static float Calculate(Struct3DPoint zero , Struct3DPoint point)
 {
     return (float)Math.Sqrt(((zero.X - point.X) * (zero.X - point.X)) + ((zero.Y - point.Y) * (zero.Y - point.Y)) + ((zero.Z - point.Z) * (zero.Z - point.Z)));
 }