This paper presents the first closed-loop control framework for cooperative payload transportation with non-stopping flying carriers. Building upon grasp-matrix formulations and internal force redundancy, we propose a feedback wrench controller that actively regulates the payload's pose while an optimization layer dynamically shapes internal-force oscillations to guarantee persistent carrier motion. Preliminary experimental results on multirotor UAVs validate the model assumptions, and numerical simulations demonstrate that the method successfully prevents carrier stagnation, achieves accurate load tracking, and generates physically feasible trajectories with smooth velocity profiles. The proposed framework not only advances the state of the art but also offers a reliable, versatile solution for future real-world applications requiring load transportation by coordinated non-stopping flying carriers.
論文ID : 2510.11413タイトル : Trajectory control of a suspended load with non-stopping flying carriers著者 : Sofia Girardello, Giulia Michieletto, Angelo Cenedese, Antonio Franchi, Chiara Gabellieri分類 : eess.SY cs.SY(システムと制御)発表日時 : 2025年10月13日(arXiv プレプリント)論文リンク : https://arxiv.org/abs/2510.11413 本論文は、非停止飛行キャリアによる協調荷重輸送のための初の閉ループ制御フレームワークを提案している。把握行列定式化と内力冗長性に基づいて、フィードバックトルク制御器を提案し、荷重姿勢を能動的に調整しながら、最適化層を通じて内力振動を動的に調整し、キャリアの継続的な運動を保証する。マルチロータ無人機での初期実験結果はモデル仮定を検証し、数値シミュレーションは、本手法がキャリアの停止を防止し、正確な荷重追従を実現し、滑らかな速度プロファイルを持つ物理的に実行可能な軌跡を生成することを示している。
本論文が解決する中核的な課題は、非停止飛行キャリア(固定翼無人機など)による吊り下げ荷重の協調輸送の閉ループ制御をいかに実現するか、特に荷重が動的軌跡追従を必要とする場合である。
応用需要 : 長距離物流輸送、人道支援、インフラ検査・建設などの応用において荷重輸送に対する緊急の需要がある技術的課題 : 固定翼無人機はマルチロータと比較してより優れた航続距離と耐久性を有するが、飛行を維持するために前進速度を保つ必要がある実用的意義 : 将来の大規模で長距離の協調空中輸送に対する理論的基礎と技術的ソリューションを提供するマルチロータの制限 : 既存研究は主にマルチロータ無人機に集中しており、その耐久性と操作範囲は限定的である開ループ制御 : 非停止キャリアに関する既存研究は開ループ軌跡計画に限定され、閉ループフィードバック制御が欠けている静的荷重 : 既存手法は荷重の静的平衡のみを考慮し、動的軌跡追従をサポートしていない初の閉ループ制御フレームワーク : 非停止飛行キャリアによる協調荷重輸送のための初の閉ループ制御システムを提案動的軌跡追従 : 既存理論を拡張し、静的平衡だけでなく荷重の動的軌跡追従をサポートオンライン最適化戦略 : リアルタイム最適化アルゴリズムを開発し、キャリア速度制約を確保するため内力パラメータを動的に調整理論と実験検証 : 数値シミュレーションと初期実験を通じて手法の有効性を検証入力 : 期望される荷重軌跡 p L d ( t ) ∈ R 3 p_{Ld}(t) \in \mathbb{R}^3 p L d ( t ) ∈ R 3 , R L d ( t ) ∈ S O ( 3 ) R_{Ld}(t) \in SO(3) R L d ( t ) ∈ SO ( 3 ) 、および対応する速度
出力 : ケーブル力軌跡 { f i ( t ) } i = 1 n \{f_i(t)\}_{i=1}^n { f i ( t ) } i = 1 n およびキャリア軌跡 { p R i ( t ) } i = 1 n \{p_{R_i}(t)\}_{i=1}^n { p R i ( t ) } i = 1 n 制約条件 :
荷重追従誤差の漸近安定性 キャリア速度制約: ∥ p ˙ R i ( t ) ∥ ≥ ε > 0 \|\dot{p}_{R_i}(t)\| \geq \varepsilon > 0 ∥ p ˙ R i ( t ) ∥ ≥ ε > 0 、∀ i = 1 , . . . , n \forall i = 1,...,n ∀ i = 1 , ... , n システムは n ≥ 3 n \geq 3 n ≥ 3 個の非停止飛行キャリアで構成され、各キャリアはケーブルを通じて共通の剛体荷重に接続されている。主要な運動学的関係:
p R i = p L + R L B b i + L i q i , i = 1 , . . . , n p_{R_i} = p_L + R_L {}^B b_i + L_i q_i, \quad i = 1,...,n p R i = p L + R L B b i + L i q i , i = 1 , ... , n
ここで q i ∈ S 2 q_i \in S^2 q i ∈ S 2 は荷重からキャリアを指す単位方向ベクトルである。
ケーブル力と荷重トルクの関係は把握行列で記述される:
w = G ( R L ) f w = G(R_L)f w = G ( R L ) f
ここで G ( R L ) ∈ R 6 × 3 n G(R_L) \in \mathbb{R}^{6 \times 3n} G ( R L ) ∈ R 6 × 3 n は把握行列である:
G ( R L ) = [ I 3 ⋯ I 3 S ( B b 1 ) R L T ⋯ S ( B b n ) R L T ] G(R_L) = \begin{bmatrix}
I_3 & \cdots & I_3 \\
S({}^B b_1)R_L^T & \cdots & S({}^B b_n)R_L^T
\end{bmatrix} G ( R L ) = [ I 3 S ( B b 1 ) R L T ⋯ ⋯ I 3 S ( B b n ) R L T ]
外側ループ荷重トルク制御器 :
fd = -Kp ep - Kv ev - Ki ∫₀ᵗ ep(τ)dτ + mL ge₃
τd = -KR eR - Kω eω - KiR ∫₀ᵗ eR(τ)dτ + ωL × (JL ωL)
内側ループキャリア軌跡生成 :
f d ( t ) = G ( R L ( t ) ) † w d ( t ) + N ( R L ( t ) ) λ ( t ) f_d(t) = G(R_L(t))^† w_d(t) + N(R_L(t))λ(t) f d ( t ) = G ( R L ( t ) ) † w d ( t ) + N ( R L ( t )) λ ( t )
最適化層 : 内力パラメータ λ ( t ) λ(t) λ ( t ) を動的に調整して速度制約を満たす。
既存の静的荷重手法と異なり、本論文は荷重姿勢変化による時変把握行列 G ( t ) G(t) G ( t ) と零空間 N ( t ) N(t) N ( t ) を考慮している。
キャリア速度の明示的表現を導出:
p ˙ R i ( t ) = v L i ( t ) + L i T i ( t ) ( E i ( t ) + G i ( t ) ) \dot{p}_{R_i}(t) = v_{L_i}(t) + \frac{L_i}{T_i(t)}(E_i(t) + G_i(t)) p ˙ R i ( t ) = v L i ( t ) + T i ( t ) L i ( E i ( t ) + G i ( t ))
ここで E i ( t ) E_i(t) E i ( t ) は外部寄与、G i ( t ) G_i(t) G i ( t ) は内力寄与である。非停止制約は以下と等価である:
0 ∉ V i : = { p ˙ R i ( t ) : t ≥ 0 } 0 \notin V_i := \{\dot{p}_{R_i}(t) : t \geq 0\} 0 ∈ / V i := { p ˙ R i ( t ) : t ≥ 0 }
最適化問題を定義:
x ∗ = arg min x ∈ R 2 J ( x ) x^* = \arg\min_{x \in \mathbb{R}^2} J(x) x ∗ = arg min x ∈ R 2 J ( x )
制約条件: ∥ v L i ( t ) + L i T i Π i ( t ) ( G ˙ i † w d + G i † w ˙ d + N ˙ i λ + N i λ ˙ ) ∥ 2 ≥ ε \|v_{L_i}(t) + \frac{L_i}{T_i}\Pi_i(t)(\dot{G}^†_i w_d + G^†_i \dot{w}_d + \dot{N}_i λ + N_i \dot{λ})\|^2 \geq \varepsilon ∥ v L i ( t ) + T i L i Π i ( t ) ( G ˙ i † w d + G i † w ˙ d + N ˙ i λ + N i λ ˙ ) ∥ 2 ≥ ε
目的関数は平滑性と連続性のペナルティ項を含む。
モデル検証実験 : 3台のCrazyflie 2.1クアッドロータ無人機、Crazyswarmソフトウェアと外部モーションキャプチャシステムを使用数値シミュレーション : 4キャリアシステム、完全な荷重とケーブルダイナミクスを考慮、ケーブル弾性などの非理想要因を含む実験荷重 : カーボンファイバーチューブで構成された三角形荷重、辺長0.515m、質量0.012kgケーブル長 : 約1mの細綿糸シミュレーション荷重 : 質量1.0kg、慣性行列0.01I₃ kg·m²シミュレーションでは複合軌跡を採用: 初期静止→x軸に沿った直線運動→最終静止、荷重速度変化時のキャリア動作を特に試験
荷重追従精度 : 位置誤差 e p e_p e p と姿勢誤差 e R e_R e R キャリア速度制約 : ∥ p ˙ R i ∥ ≥ ε = 0.2 \|\dot{p}_{R_i}\| \geq \varepsilon = 0.2 ∥ p ˙ R i ∥ ≥ ε = 0.2 m/s軌跡平滑性 : 速度プロファイルの連続性初期実験(図3)は以下を確認した:
軌跡追従精度 : マルチロータ無人機は楕円参照軌跡を正確に追従できる荷重安定性 : キャリア運動中、荷重姿勢は安定を保つモデル有効性 : 簡略化された理論モデルと実際のシステム動作は高度に一致キャリア軌跡 : 急旋回が発生し、瞬間速度がゼロに低下荷重追従 : 平均位置誤差0.013m、追従性能は良好速度制約 : 非停止制約を複数回違反キャリア軌跡 : 滑らかな楕円軌跡、急旋回を回避荷重追従 : 平均位置誤差0.015m、わずかに高いが許容範囲内速度制約 : ∥ p ˙ R i ∥ ≥ 0.2 \|\dot{p}_{R_i}\| \geq 0.2 ∥ p ˙ R i ∥ ≥ 0.2 m/s を厳密に満たす軌跡特性 : 荷重が静止時、キャリアは旋回飛行(loitering)を実行制約満足 : 最適化アルゴリズムはキャリア速度が常に閾値以上であることを確保追従性能 : 速度制約の導入は荷重追従精度への影響が軽微平滑性 : 最適化後の軌跡はキャリア運動の平滑性を大幅に改善初期研究は単一マルチロータによる吊り下げ荷重輸送に集中し、主に振動抑制問題を解決5-7 。
複数マルチロータの協調輸送に拡張し、荷重の6自由度制御を実現8-13 、ただしホバリング能力に依存。
最近の理論研究14,15 は非停止キャリアが荷重の静的平衡を維持する可行性を確立したが、開ループ制御に限定。
本論文は非停止キャリアによる動的荷重追従の閉ループ制御を実現した初の手法であり、理論と実用応用の間の重要なギャップを埋める。
理論的突破 : 非停止飛行キャリアの閉ループ荷重軌跡追従制御を初めて実現技術的革新 : オンライン最適化戦略はキャリア速度制約と荷重制御の結合問題を効果的に解決実用性検証 : 複雑な軌跡(静的+動的組合せ)下での良好な性能キャリアダイナミクスの簡略化 : 固定翼無人機の完全なダイナミクス制約を考慮していない最適化求解 : 場合によっては最適化問題が解を持たない可能性実験範囲 : マルチロータプラットフォーム上での初期検証のみ精密軌跡計画 : 入力飽和とキャリア特定の状態制約を考慮予測制御 : 反応的最適化の代わりにローリングホライズン法を採用実固定翼検証 : 実際の非停止無人機での包括的な実験検証メカトロニクス : ケーブルと荷重の機械的取付適応を処理革新性が強い : 非停止キャリアの閉ループ荷重制御問題を初めて解決し、重要な理論的価値を持つ手法が完全 : 理論モデリングから制御設計、実験検証まで、完全な技術チェーンを形成数学的厳密性 : キャリア速度制約の数学的特性化は厳密で、最適化問題の設計は合理的実用的価値 : 長距離荷重輸送に対して実行可能な技術経路を提供実験検証が限定的 : マルチロータプラットフォーム上での検証のみで、実固定翼無人機実験が欠けている最適化ロバスト性 : 最適化問題の可行性とロバスト性について十分に議論されていない外乱処理 : 外部外乱とモデル不確実性への対処能力は今後の検証が必要計算複雑度 : オンライン最適化の計算負荷とリアルタイム性についてより詳細な分析が必要学術的貢献 : 非停止キャリア協調制御の新しい研究方向を開拓応用前景 : 無人機物流、救援などの応用に重要な技術基盤を提供再現性 : 手法記述が詳細で、パラメータ設定が明確で、良好な再現性を持つ長距離物流 : 特に長航続距離が必要な荷重輸送タスクに適用応急救援 : 遠隔地での物資投下海洋作業 : 海上プラットフォーム間の物資輸送軍事応用 : 戦術物資の空中投下本論文は16篇の関連文献を引用し、吊り下げ荷重輸送、マルチロータ協調制御、固定翼無人機応用などの主要分野をカバーし、研究に堅実な理論的基礎を提供している。特に重要な参考文献には以下が含まれる:
総合評価 : これは非停止飛行キャリア協調制御分野で重要な貢献をした高品質な制御理論論文である。実験検証の面ではまだ改善の余地があるが、その理論的革新性と実用的価値により、この分野の重要な進展となっている。