CForest new version

Do not focus on the documentation, I am leaving it for the end since there are a lot of changes and probably more to come.
As Ioan suggested, I removed this method from base::Planner class. The type T should have this function implemented (as RRTstar) or it will return compilation errors (in a book I saw this was OK when working with templates).