Dodanie funkcji h(start, goal)

This commit is contained in:
andrzej 2020-04-26 22:05:27 +02:00
parent 1e265ec281
commit 32c80c0c0e

View File

@ -2,6 +2,7 @@ from warehouse import Coordinates, Tile, Pack
from attributes import PackStatus, TURN_LEFT_DIRECTIONS, TURN_RIGHT_DIRECTIONS
from queue import PriorityQueue
from pathfinder import Node
from math import sqrt
class Agent:
def __init__(self, start_x, start_y, assigned_warehouse, radius=5):
@ -141,6 +142,11 @@ class Agent:
# tu chodzi o to że zmieni się akcja i rodzić, ale stan nie
# zamień w fringe stary węzeł o stanie x[1] z węzłem x
def h(self, start, goal):
diff_x = pow(goal.x_position - start.x_position,2)
diff_y = pow(goal.y_position - start.y_position, 2)
return round(sqrt(diff_x+diff_y), 3)
def get_succ(self, elem):
move = self.move
turn_left = self.turn_left