start_position 0.07 0.08 0.0
goal_position 0.66 1.98 0.13
start_yaw 1.32
goal_yaw 1.32
