基于MRPs/NPUPF的地磁/加速度计测量的姿态估计新方法

针对现有基于地磁/加速度计的姿态估计算法存在状态误差协方差阵的奇异值和需要准确已知当地地磁矢量的问题,提出了一种新的姿态估计基本方法。该方法采用修正罗德里格参数(MRPs)表示系统动态,消除了采用四元数法导致的状态误差协方差阵的奇异值问题;根据地磁场缓变的特性,将地磁矢量作为平稳过程加入到状态变量中,使得姿态估计不再需要准确已知当地地磁矢量。针对大初始误差和有色噪声对基本方法的影响,通过引入模型误差预测(NPF)和无迹粒子滤波(UPF)方法对其进行改进,提出了基于模型预测无迹粒子滤波(NPUPF)的地磁/加速度计的姿态估计新方法。仿真结果表明,NPUPF方法可在大初始误差和非高斯条件下实现高精度的姿态估计,提高了基于地磁/加速度计的姿态估计方法的可靠性和实用性。