updated to work with clear_costmap_recovery