Skip to content
Snippets Groups Projects
Commit cac4559a authored by Erik Nygren's avatar Erik Nygren :bullettrain_front:
Browse files

added new path finding method. improved speed slightly...

parent 5c23531a
No related branches found
No related tags found
No related merge requests found
...@@ -136,7 +136,8 @@ def connect_straigt_line(rail_trans, grid_map, start, end, openend=False): ...@@ -136,7 +136,8 @@ def connect_straigt_line(rail_trans, grid_map, start, end, openend=False):
def quick_path(grid_map, start, end, forbidden_cells=[], openend=False): def quick_path(grid_map, start, end, forbidden_cells=[], openend=False):
""" """
Quick path connecting algorithm with simple heuristic to allways follow largest value of vector towards target.
When obstacle is encountereed second direction of vector is chosen.
""" """
# Helper function to make legal steps # Helper function to make legal steps
(height, width) = np.shape(grid_map.grid) (height, width) = np.shape(grid_map.grid)
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment