2025-11-12T03:49:09.545098

Trajectory control of a suspended load with non-stopping flying carriers

Girardello, Michieletto, Cenedese et al.
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.
academic

Trajectory control of a suspended load with 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 (Systems and Control)
  • 发表时间: 2025年10月13日 (arXiv预印本)
  • 论文链接: https://arxiv.org/abs/2510.11413

摘要

本文提出了首个用于非停止飞行载体协同载荷运输的闭环控制框架。基于抓取矩阵公式和内力冗余，提出了一个反馈扭矩控制器来主动调节载荷姿态，同时通过优化层动态调整内力振荡以保证载体持续运动。在多旋翼无人机上的初步实验结果验证了模型假设，数值仿真表明该方法成功防止了载体停滞，实现了精确的载荷跟踪，并生成了具有平滑速度轮廓的物理可行轨迹。

研究背景与动机

研究问题

本文要解决的核心问题是：如何实现非停止飞行载体（如固定翼无人机）协同运输悬挂载荷的闭环控制，特别是当载荷需要进行动态轨迹跟踪时。

问题重要性

  1. 应用需求：长距离物流运输、人道主义救援、基础设施检查和建设等应用对载荷运输有迫切需求
  2. 技术挑战：固定翼无人机相比多旋翼具有更好的航程和续航能力，但必须保持正向速度才能维持飞行
  3. 实际意义：为未来大规模、长距离的协同空中运输提供理论基础和技术方案

现有方法局限性

  1. 多旋翼限制：现有研究主要集中在多旋翼无人机，其续航能力和操作范围有限
  2. 开环控制：已有的非停止载体研究仅限于开环轨迹规划，缺乏闭环反馈控制
  3. 静态载荷：现有方法只考虑载荷的静态平衡，不支持动态轨迹跟踪

核心贡献

  1. 首个闭环控制框架：提出了第一个用于非停止飞行载体协同载荷运输的闭环控制系统
  2. 动态轨迹跟踪：扩展了现有理论，支持载荷的动态轨迹跟踪，而不仅仅是静态平衡
  3. 在线优化策略：开发了实时优化算法，动态调整内力参数以确保载体速度约束
  4. 理论与实验验证：通过数值仿真和初步实验验证了方法的有效性

方法详解

任务定义

输入：期望的载荷轨迹 pLd(t)∈R3p_{Ld}(t) \in \mathbb{R}^3, RLd(t)∈SO(3)R_{Ld}(t) \in SO(3)，以及相应的速度 输出：缆绳力轨迹 {fi(t)}i=1n\{f_i(t)\}_{i=1}^n 和载体轨迹 {pRi(t)}i=1n\{p_{R_i}(t)\}_{i=1}^n约束条件：

  1. 载荷跟踪误差渐近稳定
  2. 载体速度约束：∥p˙Ri(t)∥≥ε>0\|\dot{p}_{R_i}(t)\| \geq \varepsilon > 0，∀i=1,...,n\forall i = 1,...,n

模型架构

1. 系统建模

系统由 n≥3n \geq 3 个非停止飞行载体组成，每个载体通过缆绳连接到共同的刚性载荷。关键运动学关系：

pRi=pL+RLBbi+Liqi,i=1,...,np_{R_i} = p_L + R_L {}^B b_i + L_i q_i, \quad i = 1,...,n

其中 qi∈S2q_i \in S^2 是从载荷指向载体的单位方向向量。

2. 抓取矩阵表示

缆绳力与载荷扭矩的关系通过抓取矩阵描述：

w=G(RL)fw = G(R_L)f

其中 G(RL)∈R6×3nG(R_L) \in \mathbb{R}^{6 \times 3n} 为抓取矩阵：

I_3 & \cdots & I_3 \\ S({}^B b_1)R_L^T & \cdots & S({}^B b_n)R_L^T \end{bmatrix}$$ #### 3. 三层控制架构 **外环载荷扭矩控制器**： ``` 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)$$ **优化层**：动态调整内力参数 $λ(t)$ 以满足速度约束。 ### 技术创新点 #### 1. 时变抓取矩阵处理 与现有静态载荷方法不同，本文考虑了载荷姿态变化导致的时变抓取矩阵 $G(t)$ 和零空间 $N(t)$。 #### 2. 载体速度约束的数学表征 推导出载体速度的显式表达式： $$\dot{p}_{R_i}(t) = v_{L_i}(t) + \frac{L_i}{T_i(t)}(E_i(t) + G_i(t))$$ 其中 $E_i(t)$ 为外部贡献，$G_i(t)$ 为内力贡献。非停止约束等价于： $$0 \notin V_i := \{\dot{p}_{R_i}(t) : t \geq 0\}$$ #### 3. 在线优化算法 定义优化问题： $$x^* = \arg\min_{x \in \mathbb{R}^2} J(x)$$ 受约束：$\|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$ 目标函数包含平滑性和连续性惩罚项。 ## 实验设置 ### 实验平台 1. **模型验证实验**：3架Crazyflie 2.1四旋翼无人机，使用Crazyswarm软件和外部运动捕捉系统 2. **数值仿真**：4载体系统，考虑完整载荷和缆绳动力学，包括缆绳弹性等非理想因素 ### 载荷规格 - **实验载荷**：碳纤维管构成的三角形载荷，边长0.515m，质量0.012kg - **缆绳长度**：约1m的细棉线 - **仿真载荷**：质量1.0kg，惯性矩阵0.01I₃ kg·m² ### 轨迹设计 仿真中采用复合轨迹：初始静止→沿x轴线性运动→最终静止，专门测试载体在载荷速度变化时的行为。 ### 评价指标 1. **载荷跟踪精度**：位置误差 $e_p$ 和姿态误差 $e_R$ 2. **载体速度约束**：$\|\dot{p}_{R_i}\| \geq \varepsilon = 0.2$ m/s 3. **轨迹平滑性**：速度轮廓的连续性 ## 实验结果 ### 模型验证结果 初步实验（图3）证实了： 1. **轨迹跟踪精度**：多旋翼无人机能够精确跟踪椭圆参考轨迹 2. **载荷稳定性**：在载体运动过程中载荷姿态保持稳定 3. **模型有效性**：简化理论模型与实际系统行为高度吻合 ### 仿真对比结果 #### 无优化情况（图5-7） - **载体轨迹**：出现急转弯，导致瞬时速度降至零 - **载荷跟踪**：平均位置误差0.013m，跟踪性能良好 - **速度约束**：多次违反非停止约束 #### 有优化情况（图8-11） - **载体轨迹**：平滑椭圆轨迹，避免急转弯 - **载荷跟踪**：平均位置误差0.015m，略高但仍在可接受范围 - **速度约束**：严格满足 $\|\dot{p}_{R_i}\| \geq 0.2$ m/s - **轨迹特性**：载体在载荷静止时执行环绕飞行（loitering） ### 关键发现 1. **约束满足**：优化算法成功确保载体速度始终高于阈值 2. **跟踪性能**：速度约束的引入对载荷跟踪精度影响轻微 3. **平滑性**：优化后的轨迹显著改善了载体运动的平滑性 ## 相关工作 ### 单载体悬挂载荷 早期研究集中在单个多旋翼运输悬挂载荷，主要解决摆动抑制问题[5-7]。 ### 协同多旋翼系统 扩展到多个多旋翼协同运输，实现载荷的六自由度控制[8-13]，但依赖悬停能力。 ### 非停止载体理论 最近的理论工作[14,15]建立了非停止载体维持载荷静态平衡的可行性，但仅限于开环控制。 ### 本文贡献定位 本文是首个实现非停止载体动态载荷跟踪的闭环控制方法，填补了理论与实际应用之间的重要空白。 ## 结论与讨论 ### 主要结论 1. **理论突破**：首次实现了非停止飞行载体的闭环载荷轨迹跟踪控制 2. **技术创新**：在线优化策略有效解决了载体速度约束与载荷控制的耦合问题 3. **实用性验证**：方法在复杂轨迹（静态+动态组合）下表现良好 ### 局限性 1. **载体动力学简化**：未考虑固定翼无人机的完整动力学约束 2. **优化求解**：某些情况下优化问题可能无解 3. **实验范围**：仅在多旋翼平台上进行了初步验证 ### 未来方向 1. **精细化轨迹规划**：考虑输入饱和和载体特定状态约束 2. **预测控制**：采用滚动时域方法替代反应式优化 3. **真实固定翼验证**：在实际非停止无人机上进行全面实验验证 4. **机电一体化**：处理缆绳和载荷的机械安装适配问题 ## 深度评价 ### 优点 1. **创新性强**：首次解决了非停止载体的闭环载荷控制问题，具有重要理论价值 2. **方法完整**：从理论建模到控制设计再到实验验证，形成了完整的技术链条 3. **数学严谨**：载体速度约束的数学表征严谨，优化问题设计合理 4. **实用价值**：为长距离载荷运输提供了可行的技术路径 ### 不足 1. **实验验证有限**：仅在多旋翼平台上进行了验证，缺乏真实固定翼无人机实验 2. **优化鲁棒性**：未充分讨论优化问题的可行性和鲁棒性 3. **扰动处理**：对外部扰动和模型不确定性的处理能力有待进一步验证 4. **计算复杂度**：在线优化的计算负担和实时性需要更详细的分析 ### 影响力 1. **学术贡献**：开创了非停止载体协同控制的新研究方向 2. **应用前景**：为无人机物流、救援等应用提供了重要技术基础 3. **可复现性**：方法描述详细，参数设置明确，具有良好的可复现性 ### 适用场景 1. **长距离物流**：特别适用于需要长航程的载荷运输任务 2. **应急救援**：在偏远地区的物资投送 3. **海洋作业**：海上平台间的物资运输 4. **军事应用**：战术物资的空中投送 ## 参考文献 本文引用了16篇相关文献，涵盖了悬挂载荷运输、多旋翼协同控制、固定翼无人机应用等关键领域，为研究提供了坚实的理论基础。特别重要的参考文献包括： - [14,15]: Gabellieri和Franchi关于非停止载体静态平衡的开创性工作 - [8-13]: 多旋翼协同运输的经典研究 - [5-7]: 单载体悬挂载荷控制的基础理论 --- **总体评价**：这是一篇高质量的控制理论论文，在非停止飞行载体协同控制领域做出了重要贡献。虽然在实验验证方面还有提升空间，但其理论创新性和实用价值使其成为该领域的重要进展。