Navigation_with_polytopes