Fix unstable test in nav2 util#4894

SteveMacenski merged 3 commits intoros-navigation:mainros-navigation/navigation2:mainfrom

mini-1235:patch-unstable-testmini-1235/navigation2:patch-unstable-testCopy head branch name to clipboard