static void Main(string[] args) { var pl = new Player(); var p = new Point3D(22, 2, 9); var p2 = new Point3D(2, 2, 9); var p3 = new Point3D(22, 2, 19); var p4 = new Point3D(22, 12, 9); Trajectory <Player> t = new Trajectory <Player>(pl, 2131); t.AddPosition(2133, p); t.AddPosition(2132, p2); t.AddPosition(2134, p3); t.AddPosition(2135, p4); Console.WriteLine(t); Console.WriteLine(t.GetPositionAt(2136)); Console.ReadLine(); KDTree <double, Point2D> kd = new KDTree <double, Point2D>(2, new DoubleMath()); kd.NearestNeighboursQuery(new double[] { 20, 20 }, 2); }