However, keep in mind that we are talking about voxels (little cubic, with voxel_size) rather than points (with no size).
you don't need this program, and a plot3 is enough to do affine transformation for points.