calc_heightmap_coords function

Calculate voxel coordinates from a matrix where values in the matrix indicate height above the ground