worked a bit on rrt algorithm, the tree is still missing