fixed crashing tests in costmap_2d