[論文レビュー] Quadrotor Formation Flying Resilient to Abrupt Vehicle Failures via a Fluid Flow Navigation Function

Matthew Romano, Harshvardhan Uppaluru+2 more|arXiv (Cornell University)|Mar 3, 2022

Distributed Control Multi-Agent Systems被引用数 4

ひとこと要約

本稿では、故障した機体を除外された特異点としてモデル化し、健全なドローンを理想流体の流れの中の粒子として扱うことで、急激な機体故障時における安全性を保証するリアルタイムで流体力学に基づくナビゲーション関数を提案する。Containtment Exclusion Mode (CEM) アルゴリズムは、ストリームラインに沿った滑り速度を動的に調整することで最小分離を維持する。実験的に、2機および6機のクアッドローターが、100Hzで動作する10msのハード制限内（0.4ms実行時間）で、故障した機体を安全に回避しながら、速度指令をリアルタイムで追跡することを確認した。

ABSTRACT

This paper develops and experimentally evaluates a navigation function for quadrotor formation flight that is resilient to abrupt quadrotor failures and other obstacles. The navigation function is based on modeling healthy quadrotors as particles in an ideal fluid flow. We provide three key contributions: (i) A Containment Exclusion Mode (CEM) safety theorem and proof which guarantees safety and formally specifies a minimum safe distance between quadrotors in formation, (ii) A real-time, computationally efficient CEM navigation algorithm, (iii) Simulation and experimental algorithm validation. Simulations were first performed with a team of six virtual quadrotors to demonstrate velocity tracking via dynamic slide speed, maintaining sufficient inter-agent distances, and operating in real-time. Flight tests with a team of two custom quadrotors were performed in an indoor motion capture flight facility, successfully validating that the navigation algorithm can handle non-trivial bounded tracking errors while guaranteeing safety.

研究の動機と目的

• 急激な機体故障が発生した後のマルチクアッドローター編隊飛行における安全性とミッション継続性を確保する課題に対処すること。
• 集中型制御や複雑なポテンシャル場最適化に依存せずに、衝突回避を保証する計算効率が高くリアルタイムなナビゲーションアルゴリズムを開発すること。
• 流体力学的原則を用いて、故障状況下におけるクアッドローター編隊の安全条件を形式的に証明すること。
• シミュレーションおよび室内モーションキャプチャシステムを用いた飛行実験を通じて、提案されたCEMナビゲーションアルゴリズムを検証すること。

提案手法

• 健全なクアッドローターを理想流体の流れの中の粒子としてモデル化し、故障した機体を流れ領域から除外された特異点として扱う。
• 目的の軌道を、除外された故障領域を自然に避けるストリームラインとして定義することで、安全な領域分割を実現する。
• 位相変数φを用いた動的スライディング速度制御機構を導入し、Δφを繰り返し調整することで、最大1.0 m/sの速度指令を追跡する。
• 実時間軌道を計算するためのContainment Exclusion Mode (CEM) ナビゲーションアルゴリズムを実装し、サドルポイントからの脱出保証を持つ修正された調和ポテンシャル場を用いる。
• 2つの安全定理を形式的に証明する：定理1は複数障害物状況下での最小安全距離を保証し、定理2は単一故障ケースにおける安全限界を提供する。
• 2次元ナビゲーション解を任意のx-y平面内での飛行方向に一般化するための回転行列拡張を用いる。

実験結果

リサーチクエスチョン

• RQ1 マルチクアッドローター編隊は、1機以上の機体が急激に故障した後、どのようにして安全性を維持し、ミッションを継続できるか？
• RQ2 局所的最小値が生じないよう、故障した機体を避けるリアルタイムで計算効率の高い軌道生成を可能にする数学的枠組みは何か？
• RQ3 流体力学に基づくナビゲーション関数は、制御誤差が有界である場合でも、最小間隔を保証できるか？
• RQ4 位相変数φの動的調整は、サドルポイントの存在下でも安全を維持しながら、正確な速度追従を可能にするか？
• RQ5 CEMアルゴリズムは、複数の故障を伴う大規模チームにどの程度スケーリング可能か？

主な発見

• CEMナビゲーションアルゴリズムは、K=1, 2, 5の各ケースでそれぞれ0.2ms、0.4ms、1msの実行時間でリアルタイム性能を達成し、100Hz動作の10msハード制限内に収まった。
• 2機のクアッドローターを用いた飛行実験では、制御誤差がδ=40cmの範囲内で有界であり、Q2が故障したQ1の除外領域から安全な距離を保った。
• 6機のクアッドローターを用いたシミュレーションでは、全エージェントペア間で少なくとも2(δ+ε)の分離が維持され、形式的安全定理の妥当性が確認された。
• アルゴリズムは、除外領域付近のサドルポイントを効果的に回避でき、これらの地点でΔφが顕著に減少し、高速移動を可能にした。
• K=2のケースで速度追従が最も正確であり、K=1およびK=5のケースよりも最大速度誤差が低く抑えられ、許容可能な計算コストを維持した。
• 理論的分析により、流体力学に基づくナビゲーション関数が、局所的最小値としてサドルポイントしか持たないことが確認され、信頼性の高い脱出と安全な軌道生成が可能であることが示された。