Android ARCore измеряет расстояние

Это мой класс для измерения расстояния между двумя объектами, размещенными в AR:

public class ARRuler {

public static final String TAG = ARRuler.class.getSimpleName();

private static final long PROCESS_POINT_DELAY = 1500L;

private static final int BOX_COLOR = Color.parseColor("#FF0000");
private static final float BOX_WIDTH = 0.05f;
private static final float BOX_HEIGHT = 0.05f;
private static final float BOX_LENGTH = 0.05f;

private static final int DISTANCE_LABEL_HEIGHT = 100;
private static final int DISTANCE_LABEL_WIDTH = 100;
private static final int DISTANCE_LABEL_TEXT_COLOR = Color.parseColor("#FF0000");
private static final int DISTANCE_LABEL_TEXT_SIZE = 10;

private static final float POLYLINE_THICKNESS = 0.05f;
private static final int POLYLINE_COLOR = Color.parseColor("#FFFFFF");


private ViroViewARCore mViroViewARCore;
private ARScene mARScene;
private List<Node> mSelectedNodes;
private List<Float> mDistances;

public ARRuler(ViroViewARCore viroViewARCore, ARScene arScene) {
    this.mViroViewARCore = viroViewARCore;
    this.mARScene = arScene;
    this.mSelectedNodes = new ArrayList<>();
    this.mDistances = new ArrayList<>();
}

public void pointSelected(Vector position) {
    Log.d(TAG, "pointSelected: " + position);

    Box box = new Box(BOX_WIDTH, BOX_HEIGHT, BOX_LENGTH);

    Material material = new Material();
    material.setDiffuseColor(BOX_COLOR);
    box.setMaterials(Collections.singletonList(material));

    Node boxNode = new Node();
    boxNode.setGeometry(box);
    boxNode.setPosition(position);

    if (mSelectedNodes.size() == 0) {
        boxNode.setClickListener(new ClickListener() {
            @Override
            public void onClick(int i, Node node, Vector vector) {
                Log.d(TAG, "onClick: First point clicked");

               mSelectedNodes.add(node);
               startDelayedProcessing();
            }

            @Override
            public void onClickState(int i, Node node, ClickState clickState, Vector vector) {

            }
        });
    }

    mARScene.getRootNode().addChildNode(boxNode);
    mSelectedNodes.add(boxNode);

    startDelayedProcessing();
}

private void startDelayedProcessing() {
    new Handler().postDelayed(new Runnable() {
        @Override
        public void run() {
            processSelectedPoints();
        }
    }, PROCESS_POINT_DELAY);
}

private void processSelectedPoints() {
    Log.d(TAG, "processSelectedPoints: ");

    if (mSelectedNodes.size() < 2) {
        Log.d(TAG, "processSelectedPoints: Only one point, return");
        return;
    }

    for (int i = 0; i < mSelectedNodes.size(); i++) {
        Log.d(TAG, "processSelectedPoints: Start looping...");

        if (i + 1 == mSelectedNodes.size()) {
            Log.d(TAG, "processSelectedPoints: Last pair reached, return");
            return;
        }

        Node start = mSelectedNodes.get(i);
        Node end = mSelectedNodes.get(i + 1);

        drawDistanceLabel(start, end);
        drawPolylines();
    }
}

private void drawDistanceLabel(Node start, Node end) {
    Vector startVector = start.getPositionRealtime();
    Vector endVector = end.getPositionRealtime();

    Log.d(TAG, "drawDistanceLabel: Vectors created!");
    Log.d(TAG, "drawDistanceLabel: startVector=" + startVector);
    Log.d(TAG, "drawDistanceLabel: endVector=" + endVector);

    float distance = startVector.distance(endVector);
    Log.d(TAG, "drawDistanceLabel: distance=" + distance);
    mDistances.add(distance);

    String distanceString = new DecimalFormat("#.###").format(distance);
    Log.d(TAG, "drawDistanceLabel: distanceString=" + distanceString);

    Text text = new Text(mViroViewARCore.getViroContext(), distanceString,
            DISTANCE_LABEL_WIDTH, DISTANCE_LABEL_HEIGHT);
    text.setColor(DISTANCE_LABEL_TEXT_COLOR);
    text.setFontSize(DISTANCE_LABEL_TEXT_SIZE);

    Node node = new Node();
    node.setGeometry(text);

    Vector labelPosition = startVector.midpoint(endVector);
    node.setPosition(labelPosition);

    mARScene.getRootNode().addChildNode(node);
}

private void drawPolylines() {
    Log.d(TAG, "drawPolylines: ");

    Polyline polyline = new Polyline(POLYLINE_THICKNESS);
    polyline.setPoints(getVectors());

    Material material = new Material();
    material.setDiffuseColor(POLYLINE_COLOR);
    polyline.setMaterials(Collections.singletonList(material));

    Node node = new Node();
    node.setGeometry(polyline);

    mARScene.getRootNode().addChildNode(node);
}

private List<Vector> getVectors() {
    Log.d(TAG, "getVectors: ");

    List<Vector> vectors = new ArrayList<>();

    for (Node node : mSelectedNodes) {
        vectors.add(node.getPositionRealtime());
    }

    return vectors;
}

}

Он рисует красный прямоугольник в позиции щелчка, а после добавления 2 полей рисует полилинию и текстовую метку с расстоянием между этими прямоугольниками. Чтобы начать использовать его, вам просто нужно скопировать его в свой проект и передать объекты ViroViewARCore и ARScene. После этого просто вызовите ARRuler.pointSelected(selectedPosition) в обратном вызове Node.ClickListener().

Не стесняйтесь задавать любые вопросы.