add node to get the costmap