-Remove call to RRT planner as it's unfinished