fixed ompl planner failure