Removed redundant forest datastructure, some code cleanup
Merge remote-tracking branch 'origin/master'