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*
Wouldn't we need to call planners_[i]->clear(); before clearing the planners_ vector?