Fixed misguided implementation of Astar and properly equipped heuristics (although they are seemingly not needed).