The code for publishing the voxel grid is done. Some synchronization problems detected.