Combining motion planning and optimization for flexible robot manipulation
RRT-connect: An efficient approach to single-query path planning