public void Query(TSVector p, FP speed, FP timeHorizon, FP TRadius, T T)
{
QuadtreeQuery tmp = new QuadtreeQuery();
tmp.p = p;
tmp.speed = speed;
tmp.timeHorizon = timeHorizon;
tmp.maxRadius = FP.One * 1000000;//avoid overflow
tmp.TRadius = TRadius;
tmp.T = T;
tmp.nodes = nodes;
tmp.QueryRec(0, bounds);
}