For the issues of non-additive system noise and time-varying measurement noise during the cooperative navigation model of multiple AUVs, this paper proposes a square-root decomposition-based Extended dimension Cubature Kalman Filtering (SRECKF) algorithm. Firstly, the multiplicative noise is incorporated into the state variables for estimation, leveraging the model to estimate the noise. Subsequently, the square-root decomposition replaces the original Cholesky decomposition, propagating the square root of the variance. Finally, simulation experiments demonstrate that the proposed algorithm offers higher localization accuracy and stability compared to the Embedded Cubature Kalman Filter (ECKF) and the Extended Dimension Cubature Kalman Filter based on the SVD decomposition algorithm (SVDECKF).

错误:搜索内容不能为空,请输入英文关键词
错误:关键词超出字数限制,请精简
高级检索

Improved Embedded Cubature Kalman Algorithm in Cooperative Navigation

  • Xiaozhen Yan,
  • Xiyu Wang,
  • Qinghua Luo

摘要

For the issues of non-additive system noise and time-varying measurement noise during the cooperative navigation model of multiple AUVs, this paper proposes a square-root decomposition-based Extended dimension Cubature Kalman Filtering (SRECKF) algorithm. Firstly, the multiplicative noise is incorporated into the state variables for estimation, leveraging the model to estimate the noise. Subsequently, the square-root decomposition replaces the original Cholesky decomposition, propagating the square root of the variance. Finally, simulation experiments demonstrate that the proposed algorithm offers higher localization accuracy and stability compared to the Embedded Cubature Kalman Filter (ECKF) and the Extended Dimension Cubature Kalman Filter based on the SVD decomposition algorithm (SVDECKF).