Generalised Mathematical Model for the Kinodynamic Planning of Multirotor UAVs and Aerial Robots using Topological Manifolds

技術要約：位相多様体を用いたマルチローターUAVのキノダイナミクス・プランニングのための一般化数学モデル

問題提起
従来のマルチローター無人航空機（MUAV）の軌道計画は、通常、車両を重心（CG）における単一の点としてモデル化する「質点」抽象化に依存している。この手法は計算効率は高いものの、車両の物理的寸法、剛体幾何学、および固定されたローター間距離（ホロノミック制約）を明示的に考慮できていない。その結果、質点モデルは、CGに対しては運動学的に実現可能であっても、幾何学的制約のためにアクチュエータ（ローター）にとっては物理的に実現不可能な軌道を生成してしまう可能性がある。この「質点キノダイナミクス・プランニングのパラドックス」は、より小さな車両構成に対して許容される経路が、同じCG軌道を共有するより大きな構成に対しては衝突の恐れがある、あるいは運動学的に無効になるという、実現可能性のギャップを引き起こす。さらに、既存の一般化モデルは、しばしば位相的一貫性を犠牲にするか、特定の構成に依存しており、多様なMUAVの幾何学的形状への適用性を制限している。

手法
著者らは、MUAVを単なる質点としてではなく、$\mathbb{R}^3$に埋め込まれた剛平面点集合（「ローター多角形」と呼ばれる）としてモデル化する、一般化された数学的フレームワークを提案している。このアプローチは、車両の構成空間を表現するために位相多様体を利用している。

1. 幾何学的表現: 車両は、$n$個の頂点（モーター）によって形成される対称で閉じた凸多角形として定義される。このモデルは、任意の頂点とCGとの距離が一定（$r$）であることを強制するホロノミック制約を課し、剛体構造を維持する。
2. 統一された運動学定式化: 本フレームワークは、同次変換行列を用いて、CGの位置と方位（オイラー角）を、すべての$n$個の頂点のグローバルなデカルト座標へとマッピングする。これにより、個々のローターの運動がCGと同じデカルト座標系内で表現される、統一されたユークリッド表現が構築される。
3. 順運動学および逆運動学:
   • 順運動学: CGの軌道と方位が与えられると、モデルはすべてのローター頂点の正確な3次元位置、速度、および加速度を算出する。
   • 逆運動学: 著者らは、時間連続的な軌道を生成するために、3次パラメトリック・キノダイナミクスモデル（3次多項式）を策定している。このアプローチは、特定の時間間隔における境界条件（位置、速度、加速度）を用いて軌道係数を解くことで、高次の多項式（例：5次または最小スナップ）の計算負荷を伴うことなく、滑らかさと連続性を保証する。
4. 制約処理: 本モデルは、明示的な動的最適化としてではなく、境界条件として動的限界（速度、加速度、ジャーク）を暗黙的に組み込んでいる。これにより、アクチュエータの制限内に軌道が留まることを保証しながら、リアルタイム実装を可能にしている。

主な貢献

1. 一般化された剛体モデル: MUAVを$\mathbb{R}^3$内の剛平面点集合として表現し、標準的な剛体自由度を維持しつつ、固定された点間距離制約を明示的に強制する数学モデル。
2. アクチュエータレベルの伝播: CGの軌道をアクチュエータレベル（頂点レベル）の軌道へと直接伝播させることを可能にする、統一された運動学定式化。これにより、標準的な質点プランニングでは不可能な、個々のローターにおける曲率、加速度、およびジャークの評価が可能となる。
3. 構成認識型プランニング: 物理的寸法を実現可能性および許容性の評価に組み込むことで、従来のプランニングを拡張するフレームワーク。これは既存の経路計画アルゴリズムを置き換えるものではなく、個々のローターに対する運動学的実現可能性の指標を付加するものである。
4. 特異点の回避: 主にデカルト座標で動作することにより、制御および運動学計算の両方において角度ベースのパラメータ化に関連する特異点を回避し、滑らかで連続的な運動生成を保証する。

結果およびシミュレーション
著者らは、様々なマルチロータ構成（トリコプター、ペンタコプター、ヘキサコプター、オクトコプター）および変化するローターアーム長（$r$）を用い、提案された位相多様体アプローチを従来の質点プランニングと比較するシミュレーション研究を実施した。

• 同一のCG、分岐するアクチュエータプロファイル: シミュレーションにより、異なる構成が同一のCG軌道を共有できる一方で、そのアクチュエータレベルの運動学的プロファイル（曲率、加速度、ジャーク）は大きく異なることが示された。
• 曲率の増幅: 結果は、ローターアーム長（$r$）が増加するにつれて、最大頂点曲率が単調に増加することを示した。例えば、固定されたCG軌道において、最大頂点曲率は0.53651（トリコプター、$r=0.30$m）から0.63956（オクトコプター、$r=0.88$m）へと上昇した。
• 定理の検証: 本研究は、「より小さなローター多角形（$r_A$）に対して許容される衝突のない経路は、$r_B \leq r_A$である場合にのみ、より大きな多角形（$r_B$）に対しても許容されることが保証される」という定理1を検証している。これは、質点プランニングが、幾何学的に制約された環境（例：狭いパイプ内）において、より大きな車両に対して誤った実現可能性を予測する可能性があることを浮き彫りにしている。
• 実現可能性指標: 提案されたモデルは、各$n$個のモーターに対して独自の制御プロファイルを生成することに成功し、各頂点を多様体内の個別の状態変数として扱うことで、過剰駆動または劣駆動の問題を解決できることを示した。

意義および主張
本論文は、このフレームワークが高レベルの経路計画（多くは質点ベース）と低レベルのアクチュエータ実現可能性の間の断絶という、MUAVの自律性における決定的なギャップに対処することを主張している。位相多様体を用いて物理的寸法をプランニング定式化に直接統合することで、本モデルは従来のプランニングに対する構成認識型の拡張を提供する。

著者らは、このアプローチが以下を実現すると主張している：

• 物理的寸法と経路の実現可能性の関係を明示的に扱うことにより、キノダイナミクス経路計画の完全性を高める。
• 完全な動的最適化を必要とせずに、アクチュエータの冗長性と幾何学的制約を扱うための体系的なメカニズムを提供する。
• 幾何学的制約が無視できない単一の車両および協調マルチ車両運用（マルチエージェント）の両方のための強固な基礎を提供する。
• CG軌道をアクチュエータコマンドにマッピングするための複雑な後処理を必要としない。なぜなら、そのマッピングは数学的定式化の中に内在しているからである。

本研究は、質点モデルは初期の意思決定には依然として有用であるが、計画された軌道が特定の幾何学的形状を持つ航空ロボットにとって物理的に実現可能であり、かつ運動学的に実現可能であることを保証するためには、提案された多様体ベースのアプローチが必要であると結論付けている。