《Drones》：Attitude and 6-DOF Rigid Motion Reconstruction of Quadrotor Aerial Vehicle Based on Quaternions and Lie Group Algorithms
编辑推荐：
四旋翼动力学的高度非线性要求对飞行器位置与姿态进行高保真重构。为避免欧拉角（Euler angles）等全局三参数表示关联的奇异性，四旋翼姿态通常采用单位四元数（unit quaternions）进行参数化，并通过积分四元数微分方程来重构。然而，标准四元数积分
四旋翼动力学的高度非线性要求对飞行器位置与姿态进行高保真重构。为避免欧拉角（Euler angles）等全局三参数表示关联的奇异性，四旋翼姿态通常采用单位四元数（unit quaternions）进行参数化，并通过积分四元数微分方程来重构。然而，标准四元数积分流程是非结构保持的。它基于一组线性微分方程，随后通过附加代数方程强制四元数的单位范数。为此，本文采用了最近提出的、基于李群（Lie groups）的结构保持姿态与位置更新算法，以克服标准流程的缺陷。数值测试案例涉及一架执行五种不同机动动作的无人机（UAV）。研究结果表明，常规算法在位置与姿态的运动学更新中可能出现不稳定性和误差，而这些误差可通过采用本文所述的几何结构保持（基于李群）算法加以规避。
论文解读：基于四元数与李群算法的四旋翼飞行器姿态与6-DOF刚体运动重构
一、研究背景与问题
四旋翼无人机因其易用性、机动性和较低生产成本，在安防、搜救、消防等领域得到广泛应用。然而，四旋翼气动行为具有深层非线性，使飞行控制器设计面临挑战。仿真中，飞行器的位置与姿态估计精度直接影响动力学模型的可信度。姿态表示方面，欧拉角等三参数全局表示存在数学奇异性，而单位四元数通过四个欧拉参数双覆盖SO(3)流形，避免了奇异问题，但也引入了单位范数约束。传统四元数积分基于一组线性微分方程，需在每步后通过额外代数归一化强制范数，形成微分代数方程（DAEs）问题。这种非结构保持的更新方法在大步长下可能产生漂移和数值不稳定，影响位置与姿态重构精度。为此，研究人员引入近期提出的基于李群的结构保持姿态与位置更新算法，旨在克服传统方法的固有缺陷。
二、研究内容与结论
研究人员以传统四元数积分方法（方法I）为基准，对比两种几何李群算法：方法II利用单位四元数与李群的同构关系，通过增量旋转向量的指数映射自然地满足单位范数约束；方法III采用对偶四元数（dual quaternions）将平动与转动耦合为统一的6-DOF刚体运动。数值实验中，对一架X构型四旋翼（QAV250碳纤维机架，6英寸加长臂）执行五种典型机动，以不同积分步长下的位置误差和姿态误差为指标进行评测。结果显示，方法II在所有测试工况中均能精确或高精度重构姿态，且位置更新优于传统方法；方法III在简单机动中表现良好，但在大步长下因机体系牛顿方程复杂而出现数值不稳定。研究证实，基于李群算法的姿态更新无需对传统仿真框架大幅改动，即可显著提升无人机前向动力学仿真的保真度，为更稳定、精确的飞行控制设计奠定基础。
三、主要关键技术方法
研究采用四阶Runge–Kutta方法积分全部常微分方程（ODEs）。动力学模型中，推力与阻力矩仅由旋翼角速度决定，忽略复杂气动效应。方法I直接积分四元数线性微分方程并显式归一化；方法II通过式(16)求解增量旋转向量，再用式(15)的指数映射重构四元数；方法III用对偶四元数指数映射(20)同时更新位置与姿态，并将牛顿方程投影至机体坐标系。数值测试中的无人机参数来自典型商用自组FPV穿越机（QAV250机架，6英寸臂）的实测与推算。
四、研究结果
3.1 测试案例I——偏航旋转
仅绕垂直z轴旋转。方法II在任意测试步长下均精确重构姿态，方法I仅在步长减小时收敛。差异源于式(10)的线性非结构保持更新与式(16)的结构保持更新之间的本质区别。
3.2 测试案例II——偏航加爬升
引入竖直爬升运动。方法II与III的姿态和位置更新均优于方法I，且二者结果相同。方法I的位置误差主要来自姿态更新误差导致全局系中推力向量计算不准。
3.3 测试案例III——滚转机动
从20米高度开始执行滚转。方法II在位置更新上优于其他方法至少两个数量级；方法III在大步长下收敛最慢，易受数值不稳定影响，归因于机体系牛顿方程(5)比全局系方程(3)更复杂，导致速度误差增大。
3.4 测试案例IV——轨道机动
无人机绕固定物体做轨道飞行。方法II在任意步长下仍能精确重构姿态，位置更新比方法I提升超过两个数量级。尽管旋转轴方向恒定，方法I仍因运动学更新非结构保持而引入明显姿态误差。
3.5 测试案例V——变角速度三维机动
采用已收敛的角速度场计算，排除动力学积分误差。方法II的姿态重构精度比方法I高出近两个数量级，表明基于李群的结构保持方法能更好地从已知角速度场（如机载传感器测量）重构姿态。
五、讨论与结论
讨论指出，方法II在位置更新上的优势完全源于其对姿态的精确重构，因为平动更新算法与常规方法相同。方法III虽然实现对刚体运动的统一描述，但机体系牛顿方程的复杂度增加，使其在大步长下呈现性能波动。忽略舍入误差时，几何方法一致达到或超过传统方法的精度。结论部分翻译如下：研究验证了采用李群算法更新旋转四元数（方法II）无需对使用四元数描述姿态的前向动力学仿真代码进行重大改动即可提升精度。未来工作将把所提运动学重构算法部署至单板计算机（如Raspberry Pi）进行实时姿态估计，并在开放式架构四旋翼平台上开展物理实验，以开发充分利用李群姿态与位置更新算法的先进飞行控制器。
