Anytime solution optimization for sampling-based motion planning
RRT-connect: An efficient approach to single-query path planning