Fixed heuristic changes to include distances to obstacles properly (now instead of the center, it uses the center of the edge closest to the node) - distance check of 0.2 and weighting of 0.05*obstaclesfoundcount