added experimental method ShortestPathWithHeuristic() using the A* search algorithm. WIP