%0 Journal Article %T 基于四元数粒子滤波的飞行器姿态估计算法研究 %A 乔相伟 %A 周卫东 %A 吉宇人 %J 兵工学报 %P 1070-1075 %D 2012 %X ?针对飞行器非线性姿态确定问题,提出了一种四元数粒子滤波算法。将状态向量分为线性部分和非线性部分分别进行处理,降低了粒子滤波的运算量。针对四元数加权求和规范化问题,通过构造拉格朗日代价函数的方法将四元数加权和问题转化为代价函数取极值时的四元数向量求解问题;并通过求取四元数误差方差矩阵对角线元素平方根的方法保证扰动四元数的规范化;利用乘性误差四元数表示四元数估计点与采样点之间的距离,求取四元数的协方差矩阵解决了旋转矢量方差计算问题。仿真实验表明,与传统的扩展卡尔曼滤波(EKF)和无迹卡尔曼滤波(UKF)算法相比,该算法估计精度更高,稳定性更好。 %K 飞行器控制、导航技术 %K 姿态估计 %K 粒子滤波 %K 四元数 %K 四元数粒子滤波 %U http://118.145.16.231/jweb_bgxb/CN/abstract/abstract326.shtml