second commit: make RRT and create Path