start_position 0.0 0.0 -0.2
goal_position 12.0 0.0 0.2
start_yaw 0.0
goal_yaw 0.0
