more improvements to CForest - RRTstar decoupling