Cleaner environment reset.
Modified findBestTransition to not collision check for all successors.