Address issue with rounding error caused by re-computing the voxel coordinate using a different precision to the PointIndexGrid/PointPartitioner.

I took this opportunity to refactor and accelerate the position conversion implementation as well.