摘要
针对弹载SINS/GPS系统的空中对准,提出一种四元数模约束条件下的非线性滤波初始对准算法。首先,利用坐标变换和四元数姿态描述,将传统的强非线性滤波对准问题转化为一个二阶弱非线性滤波问题;其次,采用二阶扩展卡尔曼滤波(EKF)对二阶非线性部分进行处理,得到一种简洁的滤波对准方案;最后,推导了四元数模约束条件下滤波算法的最优实现,及反馈四元数估计结果时的闭环滤波形式。利用车载MEMS IMU/GPS系统,进行了初始对准的地面试验,结果表明,在车辆弱机动条件下,对准算法能够实现姿态和惯性器件误差的快速估计,实现惯导系统的对准。
A norm constraint quaternion nonlinear filtering in-motion alignment method is proposed in this paper for missile-borne SINS/GPS systems. Based on coordinate transformation and quaternion description, the traditional strong nonlinear alignment problem is simplified to a weak second order nonlinear one. Then the second order extended Kalman filter(EKF) is used to process the weak nonlinear part and a simple alignment algorithm is obtained. Finally, the optimized elosed-loop implementation of the proposed method is deduced under the quaternion norm constraint. Alignment experiment indicates that under weak maneuver of the land vehicle, the attitude and sensor errors can still converge fast.
出处
《宇航学报》
EI
CAS
CSCD
北大核心
2016年第9期1107-1113,共7页
Journal of Astronautics
基金
国家自然科学基金(61273333)
关键词
空中对准
模值约束
准线性滤波
二阶扩展卡尔曼滤波
In-motion alignment
Norm constraint
Quasi-linear filtering
Second order extended Kalman filter