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.
clear() is a virtual function. Virtual functions should not be called from constructors or destructors. Please add a non-virtual freeMemory() function which gets called by both clear() and the destructor.