Integrated new controller into RRT