3D-Distance between two 3D points

(work in progress)