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*
It's the change below that is the real bug fix. Without timeBetweenUpdates would be 0 and the progress callback would be called as often as possible!