Remove clear_costmap for now