Add initialization of voxel grid