CForest first version

Sorry about the (void) convention in functions, this is what happens when you copy and paste ignoring the other changes :)  Other RRTstar tweaks have been also overwritten.
if CForest creates a special sampler, it can feed RRT* states from statesToInclude (if not empty) or generate random ones. It can also do this stuff in the if (isCForest_) statement.