Observer-Based Estimation and Hydrostatic Inertia Modeling for Cooperative Transport of Variable-Inertia Loads with Quadrotors

这篇论文提出了一种针对多旋翼无人机（Quadrotors）协同运输变惯量载荷的观测器设计与流体静力惯性建模方法。该研究特别关注载荷质量随时间变化（如液体泄漏或排放）以及内部流体运动导致惯性张量变化的情况。

以下是该论文的详细技术总结：

1. 研究问题 (Problem Statement)

在协同空中运输任务中，现有的控制与估计模型通常假设载荷的质量和惯性是恒定的。然而，在实际应用中（如运输液体罐、泄漏的容器或可排放载荷），载荷的质量 ($m_L(t)$) 和 惯性张量 ($J_L(t)$) 会随时间动态变化。

• 挑战：
  • 质量变化会导致重力补偿失效，影响闭环控制性能。
  • 内部流体运动（如晃荡）导致惯性张量的高维动态变化，难以在线实时识别完整的惯性张量。
  • 缺乏直接测量惯性张量的传感器，且流体重新分布依赖于运动状态，建模复杂。
• 目标：开发一种基于几何控制的框架，结合观测器进行在线质量估计，并利用流体静力近似和查找表策略处理变惯性问题，实现弹性缆绳连接的多无人机协同运输。

2. 方法论 (Methodology)

A. 几何建模与控制设计

• 流形建模：基于 $SE(3)$ 流形构建多无人机 - 载荷系统的内蕴几何模型。系统配置空间包括刚性载荷、弹性缆绳和无人机姿态。
• 降阶动力学：利用变分原理推导出包含时变质量 $m_L(t)$ 和时变惯性 $J_L(t)$ 的受控欧拉 - 拉格朗日方程。
• 控制律：设计了几何跟踪控制器，将控制输入分解为平行于缆绳和垂直于缆绳的分量，解耦了载荷动力学与缆绳动力学，并引入了反馈项以简化闭环方程。

B. 载荷质量估计 (Mass Estimation)

• 参数化模型：假设质量遵循某种参数化模型（如常数、孔口泄漏模型、粘性泄漏模型）。
• 观测器设计：构建了一个基于梯度下降法的在线质量观测器。
  • 利用可测量的运动学状态（位置、速度、加速度）和指令控制力。
  • 定义二次代价函数，通过最小化预测动力学与实际测量之间的误差来更新质量参数估计值 $\hat{\theta}$。
• 收敛性分析：利用输入到状态稳定性（eISS）理论分析误差动力学。指出为了获得良好的估计收敛性，需要满足**持续激励（Persistent Excitation）**条件，即载荷的加速度和速度向量在时间窗口内不能共线。这通过路径规划中的“张力样条”叠加微小抖动（dither）信号来实现。

C. 惯性张量建模与更新 (Hydrostatic Inertia Modeling)

• 流体静力近似：鉴于实时识别流体惯性的高难度，论文提出利用流体静力平衡假设。当载荷的平移加速度、角加速度和加加速度（Jerk）受到限制时，流体表面近似为垂直于机体坐标系重力方向的平面。
• 离线预计算与查找表：
  • 基于已知的罐体几何形状和流体密度，离线计算不同填充水平（Fill Level）和姿态下的惯性张量。
  • 构建查找表（Look-up Table），索引为估计的质量（对应填充水平）和测量的载荷姿态（对应重力方向）。
  • 在线运行时，根据实时估计的质量 $\hat{m}(t)$ 和姿态 $R_L(t)$ 查询并更新惯性张量 $J_L(t)$。
• 有效性条件：通过纳维 - 斯托克斯方程分析，指出该近似在低加加速度（Low Jerk）轨迹下是有效的，避免了剧烈的流体晃荡。

3. 主要贡献 (Key Contributions)

1. 结构保持的降阶方程：推导了连接弹性缆绳的多无人机 - 载荷系统的几何降阶方程，明确包含了时变质量和时变惯性项。
2. 在线质量观测器：提出了一种无需额外硬件（如称重传感器）的在线质量估计器，能够处理常数、泄漏等多种质量变化模型，并分析了其在有界干扰下的误差动力学。
3. 流体静力惯性代理模型：创新性地提出了一种计算高效的惯性更新策略。利用离线预计算的查找表替代复杂的实时流体动力学求解，通过“质量 - 姿态”索引实现惯性张量的实时更新，并给出了该近似有效的轨迹平滑性条件。
4. 路径规划权衡：揭示了最小控制能量轨迹（如三次样条）与参数估计所需的持续激励之间的权衡，提出了结合平滑参考轨迹与微小抖动信号的路径规划策略。

4. 仿真结果 (Simulation Results)

论文通过四旋翼无人机协同运输刚性载荷的数值仿真验证了所提方法：

• 场景设置：包含常数质量和指数衰减质量（模拟泄漏）两种情况，并加入了位置/速度噪声和模拟风扰。
• 质量估计：
  • 在常数质量下，观测器快速收敛，即使初始误差较大。
  • 在变质量下，观测器成功跟踪了质量的指数衰减趋势，使控制器能够准确进行重力补偿。
• 惯性更新：
  • 惯性张量的对角线元素（$J_{xx}, J_{yy}, J_{zz}$）随质量减少而平滑下降。
  • 基于查找表的估计值与真实值高度吻合，证明了流体静力近似在平滑轨迹下的有效性。
• 控制性能：在两种质量场景下，载荷位置均能稳定收敛至期望平衡点，证明了闭环系统的鲁棒性。

5. 意义与展望 (Significance and Future Work)

• 理论意义：首次将几何控制、在线参数估计与流体静力惯性代理模型相结合，解决了弹性缆绳协同运输中变惯量载荷的控制难题。
• 应用价值：为液体运输、灾难救援（如运输泄漏容器）等实际场景提供了可行的控制方案，无需昂贵的专用传感器即可实现高精度控制。
• 未来工作：
  • 进行多无人机实地飞行实验验证。
  • 改进机载状态估计（特别是加速度和姿态）。
  • 探索超越流体静力区域（如剧烈晃荡）的模型，结合数据驱动的残差修正或降阶模型。

总结：该论文通过结合几何控制理论与流体静力近似，提出了一套完整的框架，有效解决了多无人机协同运输中因载荷内部流体运动导致的质量与惯性时变问题，显著提升了系统的适应性和鲁棒性。