Fixed A* path extraction