Implemented insertion into Octree