astar path finding first pass