start_position 0.0 0.15 0.0
goal_position -0.1 1.25 1.575
start_yaw 0.0
goal_yaw 0.0
a_star_iteration_limit 2000
step_planner_status dev
plan_then_snap_status test