AVP demo stuck trying to change gear
Description
After !1027 (merged) is merged this issue came up.
How to Reproduce
Run the AVP demo on current master or on ec58b50e
Current Behavior
When we run AVP demo, the vehicle localizes but doesn't move saying
[behavior_planner_node_exe-18] [INFO] [1637576648.224868829] [planning.behavior_planner_node]: Trying to change gear
And there is no planning/control routes or visualization on rviz2
.
Expected behavior
AVP demo works well.