Working on RRT search.