start_position 3.336 0.056 -0.000
goal_position 12.746 0.055 -0.000
vis_graph_status test
