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);
}
