adding RRT and Value Iteration