Some fixes to RRTForest