3D distance measurement