メインコンテンツまでスキップ

距離の推定

固定角度カメラの使用​

ビジョントラッキングカメラがロボットに取り付けられており、地面と視線の間の角度が変わらない場合、この技術を使用してターゲットまでの距離を非常に正確に計算することができます。この距離値を使用して、ロボットを前後に動かして完璧な範囲に入るか、発射機構の出力を調整することができます。

以下の図をご覧ください。この文脈では、すべての変数が既知です：ターゲットの高さ（h2）はフィールドの特性として既知であり、床からのカメラの高さ（h1）とその取り付け角度（a1）も既知です。Limelight（またはあなたのビジョンシステム）はターゲットへのy角度（a2）を教えてくれます。

距離推定

次の方程式を使用してdを解くことができます：

tan(a1+a2) = (h2-h1) / d

「d = (h2-h1) / tan(a1+a2)」

「tan」関数は通常、ラジアン単位の入力を期待します。角度の測定値を度からラジアンに変換するには、（3.14159/180.0）を掛けます。以下の完全なコード例をご覧ください。

    NetworkTable table = NetworkTableInstance.getDefault().getTable("limelight");
    NetworkTableEntry ty = table.getEntry("ty");
    double targetOffsetAngle_Vertical = ty.getDouble(0.0);

    // Limelightが完全に垂直から何度後ろに回転していますか？
    double limelightMountAngleDegrees = 25.0; 

    // Limelightレンズの中心から床までの距離
    double limelightLensHeightInches = 20.0; 

    // ターゲットから床までの距離
    double goalHeightInches = 60.0; 

    double angleToGoalDegrees = limelightMountAngleDegrees + targetOffsetAngle_Vertical;
    double angleToGoalRadians = angleToGoalDegrees * (3.14159 / 180.0);

    // 距離を計算
    double distanceFromLimelightToGoalInches = (goalHeightInches - limelightLensHeightInches) / Math.tan(angleToGoalRadians);

この技術を使用する場合、カメラの取り付け角度を慎重に選択することが重要です。近すぎる場合も遠すぎる場合もターゲットを見ることができるようにしたいです。また、この角度が変わらないようにしたいので、しっかりと取り付け、取り付け構造にスロットを使用することは避けてください。

角度a1を把握するのに苦労している場合は、上記の方程式を使用してa1を解くこともできます。ロボットを既知の距離（カメラのレンズから測定）に配置し、同じ方程式をa1について解きます。

ターゲットがカメラとほぼ同じ高さにある場合、この技術は役に立ちません。

面積を使用した距離の推定​

距離を推定するもう一つの簡単な方法は、追跡している輪郭の面積を使用することです。これは実装が非常に簡単な方法ですが、非常に正確な結果は得られません。既知の距離からビジョンカメラをターゲットに向け、ブロブの面積を記録するだけです。実際のフィールドのビジョンターゲットの正確な表現を使用していることを確認し、希望する射撃位置からそれを指していることを確認してください。これをいくつかの異なる距離から行い、これらの値のテーブルを作成することができます。2016年には、この方法を使用して、ゴールからの距離に基づいて2軸ターレットの照準を調整しました。