Fixed bugs on FrontOctree. It seems that this implementation has worse performance than the original, but need more tests.