Added implementation of AnytimeRRTs for double integrator