Updated RRT planner base class and implementation