技術要約：単一の制御バリア関数制約による、センシング範囲制約下での剛性考慮型フォーメーション・トラッキング

1. 問題設定

本論文は、非線形ダイナミクスを持ち、限定されたセンシング範囲内で動作する**ヘテロジニアス（異種混合）マルチロボットシステム（MRS）**における、フォーメーション・トラッキングと剛性維持の課題に取り組んでいる。

GPSが利用できない環境（屋内、水中、深宇宙など）では、エージェントは局所的な相対測定に依存する。方位ベース（bearing-based）のフォーメーション制御は、最小限のセンシング要件に対して効果的であるが、通常、ミッションを通じて**剛な通信グラフ（rigid communication graph）が維持されることを前提としている。しかし、エージェントのセンシング範囲（$\lambda$）が限定されている実用的なシナリオでは、通信リンクが動的に切断または形成される可能性があり、それが方位剛性（bearing rigidity）**の喪失を引き起こす可能性がある。剛性は、一意のフォーメーションを確立し維持するための前提条件であるため、剛性の喪失は、個々のトラッキング目標が達成されていても、フォーメーションの失敗につながる。

核心となる問題（問題1）は、以下の条件を満たすヘテロジニアスなエージェントのための分散型制御戦略を設計することである：

1. 所望のリーダー軌道および方位ベクトルによって定義される一意の剛なフォーメーションを達成する。
2. センシング範囲の制限によってリンクが脱落する可能性があるにもかかわらず、常に方位剛性を維持する（$\det(B_{ff}(t)) \neq 0$）。
3. 近傍からの局所的な相対情報のみを使用して動作する。

2. 手法

提案手法は、フォーメーション・トラッキングと剛性維持を、二次計画法（QP）フレームワーク内の単一の制御バリア関数（CBF）制約へと統合するものである。

2.1 システムおよびグラフモデル

• ダイナミクス: エージェントは平面ロボットとしてモデル化され、非線形ダイナミクス（$\dot{p}_i = v_i, \dot{v}_i = f_{v_i}(v_i) + h_{v_i}(v_i)u_i$）を持つ。これには、二重積分器、差動駆動、アッカーマン駆動車両が含まれる。
• グラフ: 通信トポロジー $G(t)$ は無向かつ時変であり、センシング範囲 $\lambda$ によって決定される。
• フレームワーク: リーダー・フォロワー構造が用いられる。リーダー（$V_L$）はグローバルな位置へのアクセス権を持ち、フォロワー（$V_F$）は局所的な方位に依存する。

2.2 剛性維持戦略

剛性が維持されていると仮定する先行研究とは異なり、本論文では剛性維持を明示的な制御目標として扱う。

• 参照割り当て: ヘネベルグ型の頂点追加シーケンスに基づき、各フォロワーには、非平行な所望の方位を持つ参照ペアの近傍（$j_1, j_2$）が割り当てられる。
• 臨界性: これらの特定の参照ペアの非共線性およびセンシング範囲の制約を維持することが、グラフ全体のグローバルな剛性を保証するために十分であることを本論文は確立している。
• 二重のターゲット: 参照リンクの状態に基づいて、コントローラーは2つのターゲットを切り替える：
  1. 方位誘導ターゲット ($p^b_{iT}$): 剛性が確保されている場合に使用される。これは、エージェントを所望のフォーメーション形状に一致させる。
  2. 剛性臨界ターゲット ($p^r_{iT}$): 参照リンクがセンシング限界に近づいたとき、または参照間の角度が共線性に近づいたときに起動される。これは、エージェントを、クリティカルなリンクが範囲内に留まり非共線性となるよう、安全マージンを最大化する位置へと引き寄せる。

2.3 制御フレームワーク：到達可能性CBF（Reachability CBF）

著者らは、これらの目的を統一するために**到達可能性制御バリア関数（reach-CBF）**を採用している。

• 安全集合およびターゲット集合: 安全集合 $X$ は、エージェントがセンシング範囲内にあり、かつ非共線性である領域として定義される。ターゲット集合 $R$ は、所望の整列のための領域として定義される。
• 単一の制約: トラッキングと安全性のための別々の制約を用いる代わりに、有限時間 $\tau$ 内にシステムがターゲット集合 $R$ に到達し、かつ前向き不変な安全集合 $X$ 内に留まることを保証する、単一の reach-CBF 制約が定式化される。
• QP定式化: 制御入力 $u_i$ は、reach-CBF 制約を満たしながら、公称コントローラーからの偏差を最小化する QP を解くことによって計算される：
  $$u_i = \arg \min_q \frac{1}{2} \|q - u_{nom}\|^2 \quad \text{s.t.} \quad K_f + K_h^\top q \geq \frac{\mu}{\tau}$$
• 安定性: 閉ループシステムは、スイッチング非線形システムとして分析される。著者らは、特定のゲイン条件と最小滞在時間（センシングおよび角度のマージンによって保証される）の下で、システムが一様最終的に有界であり、一意のフォーメーションが達成されることを証明している。

3. 主な貢献

1. 統合フレームワーク: フォーメーション・トラッキングと剛性維持を単一の reach-CBF 制約へと統合する新しい制御フレームワークを提供し、複雑な多層的制約処理の必要性を排除した。
2. 局所的な剛性維持: 「剛性臨界」な参照ペアを特定し維持することにより、局所的な相対情報のみを用いてグローバルな剛性維持を実現した。これにより、恒久的な剛性の仮定を排除した。
3. ヘテロジニアスへの対応: 本手法は、非線形ダイナミクス（例：二重積分器および差動駆動ロボット）を持つヘテロジニアスなシステムに適用可能である。
4. 分散実装: コントローラーは近傍のローカルデータのみを必要とするため、スケーラブルであり、分散運用に適している。

4. 結果

本手法は、2次元空間における8体のエージェント（リーダー2体、フォロワー6体）を用いたシミュレーション（二重積分器および差動駆動モデルを含む）によって検証された。3つのシナリオがテストされた：

• ケース (i) 公称トラッキング: エージェントは、方位誤差が $\approx 10^{-2}$ に収束しながら、移動するフォーメーションを正常に追従した。
• ケース (ii) 剛性維持なしの摂動: 0～7秒の間、フォロワー1（エージェント3）およびフォロワー2（エージェント4）の位置に対して、それぞれ摂動 $[-0.05, 0.04]$ および $[-0.01, 0.04]$ が加えられた。その結果、フォロワー5（エージェント7）がフォロワー2（エージェント4）との接続を失い、$\det(B_{ff}) \to 0$（すなわち、$\log_{10}(| \det(B_{ff})|) \approx -12$）となるネットワーク剛性の喪失を招いた。方位誤差自体は小さく保たれたものの、剛性の喪失により平均フォーメーション誤差が大幅に増加し、フォロワー7は所望のフォーメーションから逸脱した。
• ケース (iii) 剛性維持ありの摂動: 同様の摂動の下で、フォロワー4とフォロワー7の間の剛性臨界リンクが保持された。その結果、フォーメーションは剛性を維持し、正常に追従された。

比較: 本論文の手法は、グローバルなスペクトル推定（例：べき乗法による剛性固有値）や単純な連結性維持（Fiedler固有値）に依存する既存の戦略と対比させている。提案手法は、グローバルな計算を回避し、単なる連結性よりも強い条件である剛性を保証する。

5. 意義と主張

本論文は、特に摂動や限定されたセンシング範囲が存在する場合、剛性維持が正確なフォーメーション・トラッキングにとって極めて重要であると主張している。明示的な剛性維持が行われない場合、局所的な方位誤差が最小化されていても、フォーメーション・トラッキング・コントローラーは失敗する可能性がある。

本研究の意義は以下の点にある：

• ギャップの解消: 理論的なフォーメーション制御（剛なグラフを前提とする）と、実用的な制約（限定されたセンシング）との間の乖離に対処している。
• 効率性: 単一の CBF 制約を使用することで、複数の制約やグローバルな推定器を必要とする手法と比較して、制御アーキテクチャを簡素化している。
• 堅牢性: 動的で制約のある環境において、フォーメーションの構造的完全性を維持するための、証明可能な安定した手法を提供している。

著者らは、今後の課題として、このフレームワークを3次元へ拡張し、障害物回避および入力制約を組み込み、航空機を用いた実験的な検証を行う予定であると述べている。