Initial version of multi-resolution voxel grid and manager