两个标记之间的距离

Question

我正在使用Metaio SDK开发AR项目，当我将相机指向它们时，我正面临计算两个标记之间距离的问题，我要做的是在每个标记上显示一个3d模型它们之间有一个特定的距离，比方说（10厘米），但是当我将距离减小到5时，我应该能够显示另一个3D模型。我使用了很多方法来实现在计算手机和目标之间的距离时总是结束的方法。

float distance = FloatMath.sqrt(pos2.getX() * pos2.getY() + pos1.getX()
                * pos1.getY());
float threshold = 50;

        int id1 = 1;
        int id2 = 2;

        boolean successful = metaioSDK.getCosRelation(id1, id2, pose2);

        if (metaioSDK != null) {

            if (pose1.getQuality() > 0 && pose2.getQuality() > 0
                    && distance < threshold) {
                if (successful) {
                    successful = false;
                    mModel1.setVisible(false);
                    mModel2.setVisible(false);
                    mModel3.setVisible(true);
                } else {
                    successful = true;
                    mModel3.setVisible(false);
                    mModel1.setVisible(true);
                    mModel2.setVisible(true);

                }
            } 

关于如何确定标记之间的距离的任何建议？ 感谢