Multi-Sensor Attitude Estimation Algorithm Based on Mahony Filter and Adaptive CKF
DOI:
CSTR:
Author:
Affiliation:

Clc Number:

Fund Project:

  • Article
  • |
  • Figures
  • |
  • Metrics
  • |
  • Reference
  • |
  • Related
  • |
  • Cited by
  • |
  • Materials
  • |
  • Comments
    Abstract:

    To address the issues of low attitude estimation accuracy and magnetic interference affecting low-cost inertial navigation devices, this paper proposes a multi-sensor fusion algorithm based on Mahony Complementary Filter and Adaptive Cubature Kalman Filter (MACKF). First, the Mahony filter is used to fuse magnetometer and accelerometer data to correct gyroscope output in real-time and actively compensate for magnetically disturbed data through a keyframe mechanism. The corrected attitude quaternion is then used in the Cubature Kalman Filter, with adaptive adjustment of the measurement noise covariance matrix to reduce magnetic interference. Vehicle-mounted experimental results show that this algorithm significantly improves attitude estimation accuracy, with roll, pitch, and yaw angle precision improved by 45.3%, 50.2%, and 32.8%, respectively, compared to traditional methods. Therefore, the proposed algorithm demonstrates excellent performance in mitigating gyroscope drift and resisting magnetic interference.

    Reference
    Related
    Cited by
Get Citation
Share
Article Metrics
  • Abstract:
  • PDF:
  • HTML:
  • Cited by:
History
  • Received:September 03,2024
  • Revised:December 31,2024
  • Adopted:January 07,2025
  • Online:
  • Published:
Article QR Code