s452422/Inteligentna_smieciarka
5
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

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

Browse Source
This commit is contained in:
Tomasz Torchalski 2023-05-05 12:21:35 +02:00
commit fcc46fcaf5
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
astar.py
View File

@ -17,9 +17,9 @@ def astar(istate, goalx, goaly, passedFields):
return steps return steps
element = successors(state, passedFields, goalx, goaly) 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: for value in element:
val = (value.xpos, value.ypos, value.orientation, value.priority) val = (value.xpos, value.ypos, value.orientation)
if val in explored: if val in explored:
continue continue
cost = state.priority + value.priority cost = state.priority + value.priority