Merge remote-tracking branch 'origin/movement_planning' into movement_planning

This commit is contained in:
Tomasz Torchalski 2023-05-05 12:21:35 +02:00
commit fcc46fcaf5

View File

@ -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