Add speed option to test which increases resolution.
Some refactoring around Octree.