A* misses 1st closest node fix