Remove drawing functions from planning::RRT