Redesigned CForest to minimize changes to asymptotically optimal planner...

...s it uses. Fix bug in benchmarking that caused huge log files. Added option for tree pruning in RRT*
I realized that the huge benchmarks files were always related to some bugs in my code. Last benchmarks had a normal size. This fix may not be necessary.