essaie d'ajouter un label pour voir comment le getDistance évolue.
Si c'est bien ça qui merde, un bidon :

int getDistance(node from, node to)
{
    vector3df pos1 = from.getPosition()
    vector3df pos2 = to.getPosition()
    int distX = from.getX() - to.getX()
    int distY = from.getY() - to.getY()
    int distZ = from.getZ() - to.getZ()
    int distance = sqrt(distX*distX+distY*distY+distZ*distZ)
    return distance
}

devrait fonctionner (attention, pas testé et c'est pas vraiment du c++)