Working version of octree
Initial capability to store data in octree. Still need unit tests and possible restructuring.