RRT-connect: An efficient approach to single-query path planning
V-Clip: fast and robust polyhedral collision detection