Added A* heuristics & updated srcipts for Dijkstra