A* with good times
* Fixed the heuristic function for nodes