start_position 0.38 0.0 0.0
goal_position 2.81 -0.72 0.03
start_yaw -0.4
goal_yaw -0.4
