fixed costmap_2d tests