Finished first version of voxel grid, sdf representation, and sdf builder