Fix/smac planner orientation goals (backport #5235)#5272

SteveMacenski merged 1 commit intokiltedros-navigation/navigation2:kiltedfrom

mergify/bp/kilted/pr-5235ros-navigation/navigation2:mergify/bp/kilted/pr-5235Copy head branch name to clipboard