两步自适应快速滤波算法测量火箭弹滚转角
|
摘要
利用地磁场测量制导火箭弹的滚转角是常用的一种方法。由于利用磁场测量时存在无法避免的误差,从而不能准确获取火箭弹滚转姿态。本文提出了两步自适应快速无迹卡尔曼滤波(TAUKF)算法,区别于现有算法,TAUKF的状态向量根据滚转角指标参数与测量电路的校正参数而提出,并且经过两步处理,在保证滤波结果精度的前提下,提高了滤波的收敛速度。通过仿真结果表明,所提出的TAUKF算法在收敛特性和计算成本方面优于现有的UKF算法。
The geomagnetic field is often used to measure the roll angle of guided rocket. Due to the unavoidable error in magnetic field measurement, the roll angle cannot be measured accurately. In this paper, a two-step Kalman filter(TAUKF) algorithm is proposed. Being different from the existing algorithm, the state vector of TAUKF is based on the roll angle and the correction parameter of the measurement circuit. And after two steps of processing, the convergence speed of the filter is improved while the accuracy of the filter result is ensured. The simulation results show that the proposed TAUKF algorithm is superior to the existing UKF algorithm in terms of convergence characteristics and computational cost.
The geomagnetic field is often used to measure the roll angle of guided rocket. Due to the unavoidable error in magnetic field measurement, the roll angle cannot be measured accurately. In this paper, a two-step Kalman filter(TAUKF) algorithm is proposed. Being different from the existing algorithm, the state vector of TAUKF is based on the roll angle and the correction parameter of the measurement circuit. And after two steps of processing, the convergence speed of the filter is improved while the accuracy of the filter result is ensured. The simulation results show that the proposed TAUKF algorithm is superior to the existing UKF algorithm in terms of convergence characteristics and computational cost.
引文
[1]张宏欣,周穗华,张伽伟.三轴磁强计实时自校正算法[J].电子学报,2017,45(7):1750-1757.
[2]黄琳,荆武兴.卫星姿态确定与三轴磁强计校正[J].宇航学报,2008,29(3):854-859.
[3] DUNIK J,SIMANDL M,STRAKA O. Unscented kalman filter:aspects and adaptive setting of scaling parameter[J].IEEE Transactions on Automatic Control,2012,57(9):2411-2416.
[4]卢兆兴,张金生,王仕成,等.基于自适应遗传算法的三轴磁强计误差校正方法[J].传感技术学报,2014,27(3):331-336.
[5]闫小龙,陈国光,杨东.抗野值卡尔曼滤波在火箭弹落点估计中的应用[J].弹箭与制导学报,2016,36(3):94-98.
[6]朱均,董大群.三轴磁强计转向差的自适应校正[J].仪器仪表学报,1999,20(4):392-397.
[2]黄琳,荆武兴.卫星姿态确定与三轴磁强计校正[J].宇航学报,2008,29(3):854-859.
[3] DUNIK J,SIMANDL M,STRAKA O. Unscented kalman filter:aspects and adaptive setting of scaling parameter[J].IEEE Transactions on Automatic Control,2012,57(9):2411-2416.
[4]卢兆兴,张金生,王仕成,等.基于自适应遗传算法的三轴磁强计误差校正方法[J].传感技术学报,2014,27(3):331-336.
[5]闫小龙,陈国光,杨东.抗野值卡尔曼滤波在火箭弹落点估计中的应用[J].弹箭与制导学报,2016,36(3):94-98.
[6]朱均,董大群.三轴磁强计转向差的自适应校正[J].仪器仪表学报,1999,20(4):392-397.