Journal of Beijing University of Posts and Telecommunications

  • EI核心期刊

Journal of Beijing University of Posts and Telecommunications ›› 2021, Vol. 44 ›› Issue (3): 79-86.doi: 10.13190/j.jbupt.2020-207

• PAPERS • Previous Articles     Next Articles

An Adaptive Hybrid Filter Algorithm for Attitude Estimation

LI Xing-hua, LIU Xiao-ping, WANG Gang, ZHAO Yun-long, LI Yong-wei   

  1. School of Modern Post, Beijing University of Posts and Telecommunications, Beijing 100876, China
  • Received:2020-10-20 Online:2021-06-28 Published:2021-06-23

Abstract: In order to solve the problems such as low precision, poor anti-jamming ability in attitude estimation algorithms based on filtering for low-cost inertial sensors, a new adaptive hybrid filter algorithm based on conjugate gradient method and complementary filter is proposed. The conjugate gradient algorithm adopted to process the data measured by accelerometer and magnetometer at first, and estimated their attitude quaternion iteratively. Then, the complementary filter is used to fuse the information of the gyro updated attitude and the iterative optimized attitude of the conjugate gradient method. Finally, according to the motion state of the carrier, the complementary filtering parameter is adjusted adaptively to obtain the optimal attitude estimation. To verify that the algorithm is feasible and anti-interference, it is compared with other filter fusion algorithms in the experiments of anti-magnetic interference and anti-interference of motion acceleration. It is shown that the proposed algorithm effectively reduces the interferences caused by magnetic field and motion acceleration, and has better precision of attitude angle estimation than that of traditional gradient descent algorithm, Gauss Newton algorithm and conjugate gradient algorithm.

Key words: attitude estimation, information fusion, conjugate gradient algorithm, complementary filter, adaptive

CLC Number: