[論文レビュー] Hierarchical Trajectory Planning of Floating-Base Multi-Link Robot for Maneuvering in Confined Environments

Yicheng Chen, Jinjie Li+4 more|arXiv (Cornell University)|Feb 25, 2026

Robotic Path Planning Algorithms被引用数 0

ひとこと要約

論文は、原点のグローバルアンカー状態をローカルの微分可能最適化と統合する階層的軌道計画フレームワークを提案し、生データの点群から狭い空間での衝突のない、動力学的に実行可能な機動を可能にする。

ABSTRACT

Floating-base multi-link robots can change their shape during flight, making them well-suited for applications in confined environments such as autonomous inspection and search and rescue. However, trajectory planning for such systems remains an open challenge because the problem lies in a high-dimensional, constraint-rich space where collision avoidance must be addressed together with kinematic limits and dynamic feasibility. This work introduces a hierarchical trajectory planning framework that integrates global guidance with configuration-aware local optimization. First, we exploit the dual nature of these robots - the root link as a rigid body for guidance and the articulated joints for flexibility - to generate global anchor states that decompose the planning problem into tractable segments. Second, we design a local trajectory planner that optimizes each segment in parallel with differentiable objectives and constraints, systematically enforcing kinematic feasibility and maintaining dynamic feasibility by avoiding control singularities. Third, we implement a complete system that directly processes point-cloud data, eliminating the need for handcrafted obstacle models. Extensive simulations and real-world experiments confirm that this framework enables an articulated aerial robot to exploit its morphology for maneuvering that rigid robots cannot achieve. To the best of our knowledge, this is the first planning framework for floating-base multi-link robots that has been demonstrated on a real robot to generate continuous, collision-free, and dynamically feasible trajectories directly from raw point-cloud inputs, without relying on handcrafted obstacle models.

研究の動機と目的

• 閉塞環境における浮遊基盤多リンクロボットのナビゲーションと構成変更に対処する。
• グローバルアンカー状態を用いて高次元計画をセグメントに分解し、計画性を実現可能にする。
• 各セグメント内で衝突回避、運動学的実現性、および動的制御性を保証する。
• 手作業の障害物モデルを用いず、点群データを直接処理できるようにする。
• シミュレーションと現実の実験でフレームワークの有効性を実証する。

提案手法

• ルートリンクを剛体の案内役として、関節を柔軟なアクチュエータとして活用し、計画問題を分割するグローバルアンカー状態を導入する。
• 低次元のA*ガイド付きルート計画と局所的な構成空間のターゲット集合評価という二段階プロセスでグローバルアンカー状態を生成する。
• アンカーステート間の各セグメントについて、境界連続性を持つ軌道を表現するためにクランプドB-スプラインのパラメータ化を用いる。
• 各セグメントに対して、微分可能な局所最適化を並行して実行し、衝突回避と可制御性を満たしつつ運動学的制限を守る。
• 手作業の障害物モデルを用いず、点群データを直接衝突検査に組み込む。
• B-スプラインのパラメータ化とセグメント連結によってセグメント間の連続性を維持する。

実験結果

リサーチクエスチョン

• RQ1 閉塞空間における浮遊基盤多リンクロボットの軌道を、グローバルな指針と局所最適化を統合してどのように計画できるか？
• RQ2 グローバルアンカー状態は高次元計画を独立して解ける並列セグメントに分解可能か？
• RQ3 このようなロボットの Differentiable Optimiza tion フレームワークで衝突回避と可制御性をどう保証するか？
• RQ4 手作業の障害物モデルを用いず、raw点群データから直接軌道を生成・検証できるか？
• RQ5 提案フレームワークの現実的な有効性は、シミュレーションと現実の実験でどの程度示されるか？

主な発見

• グローバルアンカー状態を備えた階層的フレームワークにより、計画問題を独立したセグメントに分解して並列で解けることを示す。
• 局所軌道はクランプドB-スプラインでパラメータ化され、セグメント連続性と微分可能な目的関数・制約を満たす。
• 点群データを直接処理して衝突検査を行い、手作業の障害物モデルを不要にする。
• 多数のシミュレーションと現実世界の実験で、硬いロボットを超える閉塞空間における関節付き空中ロボットの機動性の利点を実証する。
• このアプローチは、生実ロボット上で rawセンサーから連続的・衝突のない動的実行可能軌道を生成する初めての浮遊基盤多リンクロボット用計画フレームワークを表す。