Acabei de ver é isso aq ó, fórmula de distância no espaço 3D (nao sei como funciona mas usa distância final - inicial)