摘要

针对组合导航姿态估计中无味四元数估计(unscented quaternion estimation,USQUE)的噪声协方差矩阵参数无法准确给出等问题,提出基于粒子群优化的USQUE(USQUE based on particle swarm optimization,PSO-USQUE)算法。通过粒子群算法对噪声协方差矩阵Q和R进行寻优,获取优化的噪声协方差矩阵等滤波先验条件;分别进行仿真实验和微机电惯导系统/GPS车载实验。实验结果表明,对于USQUE的姿态估计问题,PSO-USQUE算法相比常规算法具有更高的精度,验证了所提算法的有效性。