Add goal pose to CriticData#4812

SteveMacenski merged 8 commits intoros-navigation:humbleros-navigation/navigation2:humblefrom

EnjoyRobotics:mppi-goal-to-critic-humbleEnjoyRobotics/navigation2:mppi-goal-to-critic-humbleCopy head branch name to clipboard