Backport #2712 to foxy#2776

SteveMacenski merged 1 commit intoros-navigation:foxy-develros-navigation/navigation2:foxy-develfrom

Jannkar:amcl_threads_fix_foxy_backportJannkar/navigation2:amcl_threads_fix_foxy_backportCopy head branch name to clipboard