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.
Oops, yes, it was a while before. I didn't test this code because it is not complete since I need your help. Thanks for the advice.