Думаю,стандартная формула
d^2=(Xc-Xk)^2+(Yc-Yk)^2+(Zc-Zk)^2
d - расстояние