← 返回论文列表

基于SO(3)的标量测量姿态估计互补滤波
Complementary Filtering on SO(3) for Attitude Estimation with Scalar Measurements

作者: Alessandro Melis, Soulaimane Berkane, Tarek Hamel
arXiv: 2604.08099v1
分类: eess.SY, cs.RO
📝 论文摘要
利用标量测量进行姿态估计,对应于部分矢量观测,当惯性矢量未被完全观测而仅沿特定机体坐标系矢量测量时,这一问题自然产生。此类测量出现在涉及不完整矢量测量或源自异构传感器信息的姿态约束问题中。基于SO(3)上的经典互补滤波器,我们提出了一种观测器,其改进的创新项专门针对这种标量输出结构。主要结果表明,在适当的持续激励条件下,当至少三个惯性矢量沿同一机体坐标系矢量测量时,几乎全局渐近稳定性得以恢复,这与SO(3)的三维结构相一致。对于双标量配置——对应于一个惯性矢量沿两个机体坐标系矢量测量,或两个惯性矢量沿同一机体坐标系矢量测量——我们进一步推导了保证在缩减吸引域内收敛的充分条件。不同示例和数值结果证明了所提出的基于标量的互补滤波器在涉及感知能力降低和/或新型感知模式的挑战性场景中,对于姿态估计的有效性。

📊 核心分析

🎯 研究动机
该论文旨在解决姿态估计中一个特定问题:当惯性向量无法被完整观测,而只能沿特定机体坐标系向量进行标量测量时,如何实现鲁棒的姿态估计。这种场景常见于传感器信息不完整或异构传感器融合的应用中。
🔧 核心方法
论文在经典的SO(3)流形上的互补滤波器(complementary filter)基础上,提出了一种改进的观测器。其核心是设计了一个专门针对标量输出结构的修正创新项(innovation term)。该方法分析了在满足持续激励(persistence of excitation)条件下,当至少三个惯性向量沿一个共同的机体坐标系向量被测量时,系统能恢复几乎全局渐近稳定性(almost-global asymptotic stability)。对于两种标量配置(一个惯性向量沿两个机体向量测量,或两个惯性向量沿一个共同机体向量测量),论文进一步推导了保证在缩小吸引域(basin of attraction)内收敛的充分条件。
💡 核心创新
论文的核心创新点在于将经典的SO(3)互补滤波器框架,系统地扩展并适配到了标量测量这一更具挑战性的场景。其独特之处在于: - 创新性地设计了针对标量输出结构的修正创新项,这是方法层面的关键创新。 - 理论上严格分析了在标量测量下,恢复几乎全局渐近稳定性所需的条件(至少三个惯性向量沿一个共同机体向量测量),这揭示了问题可解性与SO(3)三维结构的内在一致性。 - 对于更受限的两种标量配置,给出了收敛的充分条件,拓展了方法在感知能力严重受限场景下的适用边界。
🏆 总体贡献
论文对该领域的整体贡献主要体现在: - 提出了一种适用于标量测量的新型SO(3)互补滤波器,为解决感知不完整或异构传感器下的姿态估计问题提供了有效的算法工具。 - 建立了该滤波器在多种标量测量配置下的严格稳定性理论,为算法在挑战性场景(如感知能力降低或新型传感模式)中的应用提供了理论保证。 - 通过数值仿真验证了所提方法的有效性,展示了其在传统方法可能失效的场景下的潜力。