RRTForest infrastructure expanded to allow path-shared
RRTForest infrastructure expanded to allow path-shared