start_position 0.0 -0.7 0.0
goal_position 9.0 0.0 0.0
start_yaw 0.0
goal_yaw 0.0
a_star_iteration_limit 120
step_planner_status test 
plan_then_snap_status test
