astar-pathfinding graph-algorithms gridworld multipolygon navigation offline-path-planners path pathfinder pathfinding pathfinding-algorithm path-planning polygon robotics shortest-path shortest-path-algorithm shortest-pathfinding-algorithm shortest-paths visibility visibility-graph visibility-graph-algorithm