cherry-pick into humble: fix multi-bugs casued by `costmap_ros_`'s early shutdown#4463

SteveMacenski merged 1 commit intoros-navigation:humbleros-navigation/navigation2:humblefrom

GoesM:humbleCopy head branch name to clipboard