start_position 1.08 0.37 0.0
goal_position 2.08 -1.66 0.04
start_yaw -2.13
goal_yaw -0.6