AStar implemented