fix costmap_tools test