The Open Motion Planning Library (OMPL)