start_position -0.05 -0.2 0.0
goal_position 2.07 -1.93 0.04
start_yaw -0.6
goal_yaw -0.6
