Fix goal handle was not freed correctly (backport #4137)#4142

SteveMacenski merged 1 commit intoironros-navigation/navigation2:ironfrom

mergify/bp/iron/pr-4137ros-navigation/navigation2:mergify/bp/iron/pr-4137Copy head branch name to clipboard