start_position 0.0 -0.7 0.0
goal_position 4.0 3.5 0.0
start_yaw 1.5707963267948963
goal_yaw 0.0
vis_graph_with_a_star_iteration_limit 80
vis_graph_status test
plan_then_snap_status test