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

距離の推定

固定角度カメラの使用​

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

以下の図を参照してください。この文脈では、すべての変数が既知です：ターゲットの高さ（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軸ターレットの照準を調整しました。