Systems Engineering and Electronics ›› 2018, Vol. 40 ›› Issue (2): 409-416.doi: 10.3969/j.issn.1001-506X.2018.02.24

Previous Articles     Next Articles

Line-of-sight angle estimation algorithm based on ideal trajectory robust cubature Kalman filter

LIU Zhenya, GAO Min, CHENG Cheng   

  1. Department of Missile Engineering, Army Engineering University, Shijiazhuang 050003, China
  • Online:2018-01-25 Published:2018-01-23

Abstract: Considering that applying the inertial measurement unit (IMU) to low-cost strapdown guided munitions is quite difficult, a line-of-sight (LOS) angle estimation algorithm with ideal trajectory parameters replacing values measured by IMU is designed. According to coordinate transformation and LOS geometrical relationship, ideal trajectory parameters are regarded as uncertain parameters to build the nonlinear filter system. An ideal trajectory robust cubature Kalman filter (ITRCKF) algorithm is proposed to the solve nonlinear system filter problem with uncertain parameters. The filter problem with uncertain system is converted into minimizing the upper bound of covariance error with parameter κ, utilizing the angle of sight with body from the seeker detector and the ITRCKF to estimate states of nonlinear systems. The experimental results show that under the condition of small disturbance, the max error of declination and the root mean square of error (RMSE) by ITRCKF are reduced by 85.57% and 81.93% respectively, compared with the cubature Kalman filter (CKF). And under the condition of large disturbance, the max error of declination and the RMSE by ITRCKF are reduced by 31.64% and 46.39% respectively. The estimated angles of LOS by the proposed algorithm meet requirements for acceptable accuracy, and have a better robust performance than CKF.

CLC Number: 

[an error occurred while processing this directive]