Reorganize code
Implement BK-forest insert