costmap_->start() called before publish; hopefully get rid of the occasional segfault