The attitude angle information of Unmanned Underwater Vehicle (UUV) is an important parameter information for UUV navigation control and navigation safety. This article proposes a combined filtering algorithm using Kalman filtering as the front filter and Mahony Kalman filtering as the back filter to improve the accuracy of attitude angle calculation for unmanned underwater vehicles. The front-end Kalman filter is used to update the optimal estimation of the inertial sensor, while the back-end Mahony Kalman filter updates the optimal estimation of the attitude angle. Based on the MPU6050 and HMC5883L inertial sensors, a nine axis UUV attitude detection system with STM32 as the main control is designed for attitude information data collection. The experimental results indicate that the combined filtering algorithm successfully reduces sensor noise, minimizes environmental interference, and enhances the accuracy of attitude calculations, thus exhibiting practical utility.

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

Attitude Calculation of Unmanned Underwater Vehicle Based on Multi Sensor Data Fusion

  • Gao Wang,
  • Yongjun Wang,
  • Zhi Li

摘要

The attitude angle information of Unmanned Underwater Vehicle (UUV) is an important parameter information for UUV navigation control and navigation safety. This article proposes a combined filtering algorithm using Kalman filtering as the front filter and Mahony Kalman filtering as the back filter to improve the accuracy of attitude angle calculation for unmanned underwater vehicles. The front-end Kalman filter is used to update the optimal estimation of the inertial sensor, while the back-end Mahony Kalman filter updates the optimal estimation of the attitude angle. Based on the MPU6050 and HMC5883L inertial sensors, a nine axis UUV attitude detection system with STM32 as the main control is designed for attitude information data collection. The experimental results indicate that the combined filtering algorithm successfully reduces sensor noise, minimizes environmental interference, and enhances the accuracy of attitude calculations, thus exhibiting practical utility.