start_position 0.0 0.15 0.0
goal_position 4.0 0.0 0.0
start_yaw 0.0
goal_yaw 0.0
plan_then_snap_status test
vis_graph_with_a_star_iteration_limit 600
vis_graph_status test