A* algorithm partially implemented