s452751/AI_PRO
1
0
Fork 1
Code Issues Pull Requests Releases Wiki Activity

graphserach v0.6.3

Browse Source
This commit is contained in:
Łukasz 2021-04-14 01:42:42 +02:00
parent d9597d3e26
commit d45ec38792
1 changed files with 34 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

42
FindPath.py
View File

@ -58,12 +58,13 @@ def graphsearch(tractor, board, TillageUnit, fringe: Queue, explored):
elem = fringe.get() elem = fringe.get()
if goaltest(elem, end_state): if goaltest(elem, end_state):
break
#TODO #TODO
return #droga ktora musi pokonac traktor #return droga ktora musi pokonac traktor
else:
explored.append(elem) explored.append(elem)
elem = succ(start_state, end_state, tractor)
fringe.put(elem)
def goaltest(elem, end_state): def goaltest(elem, end_state):
@ -72,6 +73,31 @@ def goaltest(elem, end_state):
else: else:
return False return False
def succ(): def succ(start_state, end_state, tractor):
#TODO if start_state[1] < end_state[1]:
return if tractor.direction == "RIGHT":
tractor.drive()
else:
tractor.direction = "RIGHT"
print("przesunalem sie w prawo")
elif start_state[1] > end_state[1]:
if tractor.direction == "LEFT":
tractor.drive()
else:
tractor.direction = "LEFT"
print("przesunalem sie w lewo")
else:
if start_state[0] < end_state[0]:
if tractor.direction == "DOWN":
tractor.drive()
else:
tractor.direction = "DOWN"
print("przesunalem sie w dol")
elif start_state[0] > end_state[0]:
if tractor.direction == "UP":
tractor.drive()
else:
tractor.direction = "UP"
print("przesunalem sie w gore")
else:
return tractor.horizontal_index, tractor.horizontal_index