技術要約: HUNT (非構造化環境における高速UAV航法および追跡：即時相対フレームによるアプローチ)

1. 問題提起

捜索救助（SAR）活動では、無人航空機（UAV）が2つの明確かつ重要なタスクを実行する必要がある。すなわち、犠牲者を見つけるために未知の非構造化環境を高速で横断することと、一度検知された標的を確実に追跡することである。現在の自律走行ソリューションは、GPSが利用できず、視覚的特徴が乏しい、あるいは動的な環境（例：密な森林、都市のビル街、崩落した建物）といった、センシング条件が悪化した状況において重大な限界に直面している。

• グローバル航法の限界: GPS、視覚慣性オドメトリ（VIO）、またはSLAMに依存する従来のアプローチは、これらの環境下では急速に劣化する。これらは永続的なランドマークやループクローズへの依存度が高いため、高速走行時にはドリフトや不安定な挙動を引き起こす。
• 相対航法の限界: 近年のオブジェクト中心の手法は、検出された物体に制御を固定することで標的を追跡することに成功している。しかし、これらの手法は「標的が最初から視認可能であり、継続的に観測可能であること」を前提としている。これらは、標的が視野内に存在しない場合に、安全かつ高速な横断を行うためのメカニズムを欠いている。

解決すべき核心的な課題は、グローバルな位置推定に依存することなく安全な高速横断を実現し、かつ脆弱なグローバルポーズ推定に立ち戻ることなくシームレスに標的追跡へと移行できる、統一されたフレームワークを実現することである。

2. 手法

提案されるフレームワークであるHUNTは、横断、捕捉、および追跡を、単一の**即時相対定式化（instantaneous relative formulation）**の中に統合する。これは、毎制御サイクルにおいて、直接観測可能なオンボード量（姿勢、高度、瞬時速度、および相対的な標的位置）から再構成される相対参照フレーム $R_t$ 内で完全に動作する。これにより、水平方向の移動や絶対的なヨー角といった、観測不可能な状態への依存を排除している。

A. 動作レジーム

HUNTは、統一された知覚・制御パイプラインによって管理される2つのモードで動作する：

1. ロイトリング・モード（探索）:

   • コンテキスト: 高い信頼度で標的が検知されていない状態。
   • 参照フレーム: $R_t$ は重力と初期ヘディングに固定され、時間の経過に対して固定された状態を維持する。
   • 状態推定: 無カルマンフィルタ（UKF）を用いて、相対位置、速度、および姿勢を推定する。水平方向の位置は直接的な観測を欠くためドリフトするが、目標生成が現在の状態推定値に対して相対的に定義されるため、ナビゲーションは堅牢に保たれる。
   • 参照生成: UAVは高度、前進速度、およびヘディングを制御する。ヘディングは初期のヨーを維持するが、モード切替を発生させることなく、潜在的な標的へと進路を誘導するために、低信頼度の検知によって弱くバイアスされることがある。
   • ナビゲーション: 現在の推定値に基づいて参照軌道を定義することで、地形を横断する。これにより、ドリフトが発生しても制御目的が適切に保たれる。

2. トラッキング・モード（追跡）:

   • コンテキスト: 高い信頼度で標的が検知された状態。
   • 参照フレーム: $R_t$ は、毎サイクルごとに検出された標的の位置に再固定される。これにより、グローバルなドリフトに関わらず、標的は$R_t$内で静止した状態となる。
   • 状態推定: UKFは、視覚的検出とステレオ視差から導出された標的相対変位を用いて状態を更新する。標的の運動に関する仮定を避けるため、プロセスモデルには線形加速度は使用されない。
   • 参照生成: UAVは、安全な離隔距離（$d_{xy}$）と垂直オフセット（$d_z$）を維持しながら、機体軸を標的に向けて配置する。

B. 制御アーキテクチャ

• 統一コントローラ: 両方のモードは、単一の非線形モデル予測制御（NMPC）によって実行される。
• 安全制約: 高次制御バリア関数（CBF）がNMPCに直接組み込まれている。障害物はステレオ深度画像から特定され、衝突までの時間（time-to-collision）のヒューリスティックにより、最も差し迫った衝突点を選択する。CBFは二次的な分離制約を強制し、リアルタイムで動的に実行可能な、衝突のない軌道を保証する。
• モード切替: 推定器の共分散トレース（$tr(P_t)$）に基づくヒステリシス・ポリシーが遷移を制御する。
  • ロイトリング $\to$ トラッキング: 不確かさが閾値（$\tau_\uparrow$）を下回ったときに発生。
  • トラッキング $\to$ ロイトリング: 不確かさがより高い閾値（$\tau_\downarrow$）を超えたときに発生。
  • ロイトリング中、低信頼度の検知はヘディングを標的の方へバイアスさせ、信頼度が十分になった際のスムーズな移行を促進する。

3. 主な貢献

• 統一された即時相対定式化: HUNTは、グローバルなポーズへの依存を排除し、グローバルな位置推定なしに、高速横断、標的捕捉、および追跡を単一の相対定式化の下で統合した初のフレームワークである。
• ドリフトに強いナビゲーション: 目標をグローバルなマップではなく即時の観測量に固定することで、水平方向の位置推定が大幅にドリフトする場合でも、安全な高速飛行を維持する。
• シームレスなモード遷移: グローバルな状態の再初期化や、脆弱なSLAM/VIOメソッドへの回帰を必要とせずに、探索（ロイトリング）と追跡の間の反応的な切り替えを可能にする。
• リアルタイムの安全性: NMPC内にCBFを組み込むことで、事前マップを必要とせず、非構造化環境における衝突回避を保証する。

4. 実験結果

本フレームワークは、都市部のコンテナ敷地、半構造化レイアウト、および密な森林など、多様な環境における広範な屋外実験を通じて検証された。

• ロイトリング性能:
  • 都市環境において、UAVはGPSの地上真値に対してヘディング誤差を2°以内に抑えつつ、約4.1 m/sの安定した前進を維持した。
  • 密な森林（林冠下）において、UAVは2.0 m/sで障害物を横断し、クリアランス・マージンを1.0 m以上に維持した。これらの条件下でのGPSログは2〜6 mの水平誤差を示しており、マップベースのナビゲーションを信頼不能にするレベルであったが、HUNTはドリフトのない飛行を維持した。
• フルSARミッション:
  • 都市探索: UAVは静止した車両の残骸を発見し、ロイトリングからトラッキングへと切り替えた。その際の変位誤差は±0.5 m以内に収まった。
  • 都市追跡: UAVは、速度最大11.4 m/sの移動標的（ATVに乗ったマネキン）を追跡し、横方向の誤差を1.2 mのコリドー内に維持した。低信頼度の検知が、切り替え前にロイトリングのヘディングを標的の方へ適切にバイアスさせた。
  • 森林探索: UAVは密な樹木を2.0 m/sで横断し、マネキンへの追跡に切り替え、激しい反射や最大25°のヘディング補正が発生したにもかかわらず、追跡を継続した。
• 定量的指標: すべてのミッションを通じて、HUNTはパラメータの再調整なしに、一貫した高速性能（平均速度最大8.85 m/s）と機敏なナビゲーション（ピーク加速度最大31.11 m/s²）を達成した。

5. 意義と主張

本論文は、横断と追跡の両方がグローバルなポーズやマッピングなしで表現できることを示すことにより、HUNTがSAR活動における自律走行の根本的な転換を象徴していると主張している。

• 劣化したセンシングへの堅牢性: 本システムは、ドリフト、特徴の希薄化、または遮蔽により、従来のGPS、VIO、およびSLAM手法が失敗する条件下で、信頼性の高い自律走行を実現する。
• 統一された能力: 「探索（未知の地形の横断）」と「追跡（標的の追従）」の間のギャップを埋めるものであり、これは相対ナビゲーションの枠組みにおいてこれまで欠落していた能力である。
• 安全性と機敏性: CBFを制御ループに組み込むことで、非構造化環境における高速走行時の安全性と動的な実現可能性を保証する。

著者らは、現在の実装ではロイトリングに固定された初期ヘディングを使用しているが、将来的な研究では、即時相対定式化を維持しつつ、探索効率を向上させ、循環的なロイトリングを防ぐために、意味的推論（例：ドアや窓の認識）や軽量な短期記憶を組み込む可能性があると述べている。