adapting goal critic for speed to goal#3641

SteveMacenski merged 4 commits intomainros-navigation/navigation2:mainfrom

goal_criticros-navigation/navigation2:goal_criticCopy head branch name to clipboard