Made observer arguments const to improve compiler inference. Added points to voxel centers support to octree_pointcloud