Finished debbugging AStar