Add todo in pathfinding