start_position 0.0 0.1 0.0
goal_position 1.2000000000000002 -0.225 0.0
start_yaw 0.0
goal_yaw 0.0
a_star_iteration_limit 60
step_planner_status test
plan_then_snap_status test