Distance entre 2points d'un objet 3D

Salut
Je realise une application en Java3D je met une scene apres j'ai des objets sur un plan c'est a dire le sol mais les objets une fois chargé la moitié on la voit sur le sol et lautre moitié en dessus je veux cette fois récuperer la distance entre le point upper et lower de l'objet je l'ai calculé de cette facon la mais une fois je récupere les valeurs elles ne sont pas juste
Code Java :

 Point3d pd = new Point3d();
    Point3d pf = new Point3d();
    b.getUpper(pd);
    b.getLower(pf);
    double height = Math.sqrt(Math.pow(pf.x-pd.x,2) + Math.pow(pf.y-pd.y,2) + Math.pow(pf.z-pd.z,2));
    System.out.println(height);

Voila le calcul que je fais j'ai pas d'erreur de compilcation mais les valeurs sont fausses
Merci pour votre ade