start_position 0.0 0.1 0.4
goal_position 3.0 0.0 0.4
start_yaw 0.0
goal_yaw 0.0
plan_then_snap_status test
a_star_iteration_limit 70
step_planner_status test