This study proposes a new integrated navigation algorithm framework for underwater vehicles, which is based on the Lie group extended Kalman filter (LG-EKF). It can be utilized for initial alignment and inertial navigation system/Doppler velocity log (INS/DVL) integrated navigation. The initial LG-EKF algorithm is improved by replacing the earth-centered earth-fixed frame with the tangent plane frame centered with the starting point and replacing the earth-centered inertial frame with the inertial frame corresponding to the tangent plane frame, which enhances the stability and universality of the filter and makes the parameter settings of the filter simple and intuitive. The new error state’s differential equations are derived. Then the observation equation of in-motion alignment and INS/DVL integrated navigation are established. The experimental results indicate that the convergence speed of the yaw angle errors based on the LG-EKF is significantly faster than that based on the EKF in the scenario of large misalignment angles, and the positioning accuracy of the LG-EKF is higher than that of the EKF in the INS/DVL integrated navigation process after initial alignment.

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

A New Integrated Navigation Algorithm Framework Based on LG-EKF for Underwater Vehicles

  • Wenguo Yang,
  • Maosong Wang,
  • Wenqi Wu,
  • Jiarui Cui

摘要

This study proposes a new integrated navigation algorithm framework for underwater vehicles, which is based on the Lie group extended Kalman filter (LG-EKF). It can be utilized for initial alignment and inertial navigation system/Doppler velocity log (INS/DVL) integrated navigation. The initial LG-EKF algorithm is improved by replacing the earth-centered earth-fixed frame with the tangent plane frame centered with the starting point and replacing the earth-centered inertial frame with the inertial frame corresponding to the tangent plane frame, which enhances the stability and universality of the filter and makes the parameter settings of the filter simple and intuitive. The new error state’s differential equations are derived. Then the observation equation of in-motion alignment and INS/DVL integrated navigation are established. The experimental results indicate that the convergence speed of the yaw angle errors based on the LG-EKF is significantly faster than that based on the EKF in the scenario of large misalignment angles, and the positioning accuracy of the LG-EKF is higher than that of the EKF in the INS/DVL integrated navigation process after initial alignment.