Wrote python script to plot trajectory of car output from RRT*