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.
Finally found it. There were actually 3 leaks, The two mentioned above and in the statesToInclude_.clear() line of RRTstar::includeValidPath(...)

Solved!