We should take queues from nav_core in nav1, as well as Locus's nav_core2, as well as what the move_base_flex folks have done