A Leader-Follower Approach for The Attitude Synchronization of Multiple Rigid Body Systems on $SO(3)$

技術要約：$SO(3)$ 上の複数の剛体システムの姿勢同期のためのリーダー・フォロワー・アプローチ

問題の定式化
本論文は、$SO(3)$上で進化する$N$個の不均一な剛体システムにおける、リーダー・フォロワー姿勢同期問題を扱う。目的は、各エージェントに対して分散型制御トルク$\tau_i$を設計し、すべての剛体の姿勢を一定の所望の方位$R_0$に同期させ、角速度をゼロに収束させることである。この問題の決定的な制約は、所望の姿勢$R_0$が単一のエージェント（リーダー、インデックス 1）のみに既知であり、残りのエージェント（フォロワー）は局所的な情報の交換のみを用いて同期を実現しなければならない点である。通信トポロジーは、無向、連結、かつ非巡回グラフ（木構造）としてモデル化されている。システムは不均一であり、これは各エージェントが異なる慣性行列$J_i$ を持つことを意味する。

手法
提案される解は、オイラー角、修正ロドリゲス・パラメータ（MRP）、または単位クォータニオンのようなパラメータ化を避け、姿勢の回転行列表現上で直接動作する分散型制御則を利用している。これらは特異点や非一意性の問題を抱えているためである。

1. グラフ理論的セットアップ: 著者らは、安定性解析を容易にするために、無向木グラフのエッジに対して仮想的な方位を定義している。エージェント $i$ と $j$ を結ぶ任意のエッジ $k$ に対して、相対姿勢 $\bar{R}_k = R_j^\top R_i$ が定義される。
2. 制御則の設計: 各エージェント $i$ の制御トルク $\tau_i$ は、局所的な相対姿勢誤差と角速度ダンピングを用いて以下のように構成される：
   $$\tau_i = -k_{\bar{R}_0}\psi(A_{1,0}R_0^\top R_1) - k_{\bar{R}}\sum_{j \in \mathcal{N}(i)}\psi(A_{i,j}R_j^\top R_i) - k_\omega \omega_i$$
   ここで、$\psi(\cdot)$ はリー代数への射影から導出された $so(3)$から$\mathbb{R}^3$への写像であり、$A_{i,j}$は異なる固有値を持つ正定値行列、$k$項は正のゲインである。$R_0$ を含む項は、リーダー（エージェント 1）に対してのみ有効である。
3. 安定性解析:
   • リアプノフ関数: 姿勢誤差行列のトレースとシステムの運動エネルギーを組み合わせたポテンシャル関数 $V$ が構築される。
   • ラサールの不変性原理: $V$ の時間微分が非正（$\dot{V} = -k_\omega \|\omega\|^2 \leq 0$）であることが示される。これにより、軌道が $\dot{V}=0$ となる最大の不変集合に収束することが確立される。これは $\omega = 0$ を意味する。
   • 平衡点の特性評価: 解析により、すべての姿勢が $R_0$ に整列する所望の集合 $\Xi_d$ と、特定の軸の周りに $\pi$ の回転を伴って姿勢が $R_0$ に整列するサドルポイントを含む、所望でない集合 $\Xi_u$ の2つの平衡集合が特定される。
   • ほぼ大域的安定性: チェタエフの定理を用いることで、所望でない平衡点が不安定であることが証明される。さらに、これらの不安定な点に対してシステムを線形化し、ヤコビ行列が虚軸上に固有値を持たないことを示すことで、著者らは安定多様体定理を援用し、所望でない平衡点の安定多様体のルベーグ測度がゼロであることを証明している。その結果、所望の平衡点はほぼ大域的に漸近安定である。

主要な貢献

• 直接的な $SO(3)$ 定式化: 本論文は、局所的なパラメータ化（MRPなど）による特異点や、単位クォータニオン（非一意性）の問題を回避するため、$SO(3)$ 上の回転行列を直接扱う制御戦略を提案している。
• 不均一システム: 制御則は、異なる慣性行列を持つ不均一な剛体に対して設計されており、これは先行研究でしばしば緩和されている条件である。
• 木トポロジー: この手法は、安定性を証明するためにインシデンス行列の特定の構造を利用しており、無向、連結、非巡回グラフ（木）に特化して設計されている。
• 局所知識によるリーダー・フォロワー: 本手法は、参照となる姿勢に関するグローバルな知識やオブザーバを必要とせずに、単一のエージェントのみが知る参照への同期を成功させている。

結果
理論的な結果は、7つの不均一な剛体を含むネットワークを用いた数値シミュレーションを通じて検証されている。

• 収束: シミュレーション結果は、隣接するエージェント間の相対姿勢が単位行列に収束すること、および全エージェントとリーダーとの間の相対姿勢が単位行列に収束することを示している。
• 速度ダンピング: すべての角速度はゼロに収束する。
• 性能: システムは、不均一な慣性行列と多様な初期条件にもかかわらず、一定の所望の姿勢 $R_0$ へと正常に同期しており、ほぼ大域的な漸近安定性の保証を確認している。

意義と主張
本論文は、$SO(3)$上のリーダー・フォロワー姿勢同期問題に対し、**ほぼ大域的な漸近安定性の保証**を伴う厳密な解を提供することを主張している。著者らは、既存の文献が局所的なパラメータ化（吸引領域を制限する）、単位クォータニオン（曖昧さを導入する）、あるいは局所的な収束結果のみを提供していることが多いことを強調している。対照的に、本研究は$SO(3)$ の固有の幾何学を尊重し、ほとんどすべての初期条件から収束を保証する制御戦略を提供している。

著者らは、現在の研究が一定の所望の姿勢および非巡回（木）通信グラフに限定されていることを述べている。彼らは、時変の所望の姿勢、通信遅延、およびより一般的なグラフトポロジーへの拡張を、将来の研究における困難な未解決問題として特定している。