ompl: Optimal Planning