Merge remote-tracking branch 'origin/movement_planning' into movement_planning
This commit is contained in:
commit
fcc46fcaf5
4
astar.py
4
astar.py
@ -17,9 +17,9 @@ def astar(istate, goalx, goaly, passedFields):
|
||||
return steps
|
||||
|
||||
element = successors(state, passedFields, goalx, goaly)
|
||||
explored.add((state.xpos, state.ypos, state.orientation, state.priority))
|
||||
explored.add((state.xpos, state.ypos, state.orientation))
|
||||
for value in element:
|
||||
val = (value.xpos, value.ypos, value.orientation, value.priority)
|
||||
val = (value.xpos, value.ypos, value.orientation)
|
||||
if val in explored:
|
||||
continue
|
||||
cost = state.priority + value.priority
|
||||
|
Loading…
Reference in New Issue
Block a user