Online path planning for kinematic-constrained UAVs in a dynamic environment based on a Differential Evolution algorithm

技術要約：動的環境における運動学的制約を持つUAVのためのオンライン経路計画

問題提起
本研究は、固定翼無人航空機（UAV）が動的な環境で作動する際の、オンライン経路計画という課題に取り組んでいる。クアッドローターとは異なり、固定翼UAVは最大曲率、最小旋回半径、および特定の方位角（ヨーおよびピッチ角）を含む独自の運動学的制約に直面する。核心となる問題は、これらの運動制約を満たしながら、静的および動的な障害物が存在する環境をナビゲートし、実現可能で衝突のない経路をリアルタイムで生成することである。システムは限定されたセンシング範囲（$R_{view}$）内で動作し、再計画間隔（$t_s$）ごとに障害物の位置と速度ベクトルを検出し、UAVが自由空間（$\Omega_{free}$）内に留まり、飛行禁止区域や潜在的な衝突を回避することを保証しなければならない。

手法
提案手法は、非一様有理Bスプライン（NURBS）による経路表現と、速度障害物（Velocity Obstacle: VO）の概念によって強化された差分進化（Differential Evolution: DE）最適化アルゴリズムを統合したものである。

• 経路表現: 経路は、制御点（$P$）と重み（$w$）によって定義されるNURBS曲線としてモデル化される。経路の始点および終点における方位制約を満たすため、最初の制御点と最後の制御点に、係数 $\lambda_1$ および $\lambda_2$ によってスケールされた3つの共線的な点を追加する。
• 最適化戦略: パラメータを直接最適化する従来のオフライン手法とは異なり、本オンライン手法では、初期の実現可能な経路に対するこれらのパラメータの「変化量」($\Delta\chi = [\Delta P, \Delta w, \lambda_1, \lambda_2]$) を最適化する。この戦略は収束を加速させることを目的としている。
• 目的関数: 最適化は、飛行エネルギーコスト（一定速度かつ風を無視した場合の経路長と仮定）を最小化し、以下の制約条件に従う：
  1. 運動学的制約: 曲率 $\kappa(s)$ は、許容最大曲率（$\kappa_{max}$）を超えてはならない。
  2. 障害物回避: UAVの位置 $p_u$ は、制限区域（$\Omega_{obs}$）に進入してはならない。
  3. 動的衝突回避: UAVの障害物に対する相対速度は、予測ホライゾン $\tau$ において、速度障害物コーン（$VO^{\tau}_{o_i/u}$）内に存在してはならない。この制約は、センシング範囲内のすべての検知された障害物（$N_{obs}$）に対して適用される。
• アルゴリズム: 制約付き最適化問題（COP）を解くために、線形成功履歴に基づく適応型差分進化法（LSHADE-COP）が、各再計画間隔ごとに採用されている。
• 制御の実装: 実現可能なNURBS曲線が生成されると、先行研究[10]に基づくベクトル場制御則にマッピングされ、UAVを経路に沿って誘導する。

主な貢献

1. オンライン・デリバティブ計画: 著者らは、従来のオフラインDE-NURBSフレームワークを、動的な障害物を扱い、約 $t_s \approx 0.1$ 秒の間隔で再計画が可能なオンラインプランナーへと移行させた。
2. 速度障害物の統合: 速度障害物アプローチを取り入れた新しい制約関数を、DE最適化プロセスに直接組み込んだ。これにより、単なるリアクティブなローカルプランナーに頼るのではなく、経路生成フェーズにおいて、移動する障害物との将来的な衝突を回避するようにアルゴリズムがペナルティを課すことが可能となった。
3. パラメータ変化の最適化: パラメータそのものではなく、NURBパラメータの変化量を最適化することで、本手法はリアルタイムアプリケーションに適した高速な収束を実現している。
4. 2Dにおける実現可能性: 本システムは、一定高度を維持し、運動学的限界を遵守しながら、2D動的環境における固定翼UAVの経路を正常に生成することに成功した。

結果
シミュレーション結果は、提案されたプランナーが、移動する障害物を含む混雑した環境においてUAVを正常にナビゲートできることを示している。

• 性能: オンラインプランナーは、著者らの以前のオフラインプランナー[5]よりも約12,000倍高速であると報告されている。
• 安全性: 速度障害物制約の導入により、この制約なしでの再計画アプローチでは失敗したり衝突に至ったりするようなシナリオにおいても、安全なナビゲーションが可能となる。
• 効率性: システムは、ミッション全体の経路を最初から再計画するのではなく、動的な障害物を回避するために必要な初期NURBS曲線のセクションのみを変更することができる。
• 視覚的検証: 計画プロセス（図1）のスナップショットおよび補足ビデオの証拠は、動的な脅威を回避しながら、滑らかで実現可能な曲線を生成するプランナーの能力を裏付けている。

意義および主張
本論文は、動的な設定における運動学的制約を持つUAVのためのオンライン経路計画の実現可能な基礎を提供すると主張している。著者らは、本手法が、他の固定翼プランナーでしば頻繁に必要とされる追加の平滑化ステップを必要としない点を強調している。現在の研究は一定高度の2Dシナリオに限定されているが、著者らはこの手法が3次元（3D）環境へ拡張可能であるように設計されていると述べている。本研究は、より単純なローカルプランナーのアプローチで見られる制限事項である「局所解（ローカルミニマ）や実行不可能な状況にUAVを導いてしまうことなく、動的な障害物を回避するための運動計画を行う」という困難な未解決問題に対し、解決への一歩を示すものとして提示されている。