start_position -2.000 -.500 0.000
goal_position 5.000 0.500 0.000
vis_graph_status test
