Attitude Estimation of aircraft Based on Quaternion SRCKF-SLAM Algorithm

Dandan Wang1, 2, Zhaokun Zhu3, Liang Yu1, Hongjie Li4 and Kaituo Tan1

  1. School of Mechanical and Electrical Engineering, Huainan normal university
    232038 Huainan Anhui,P.R.China
    lansejingling1988@126.com
  2. Human-computer collaborative robot Joint Laboratory of Anhui Province
    232038 Huainan Anhui,P.R.China
  3. School of Information Engineering, Zhengzhou Technology and Business University
    475000 Zhengzhou Henan,P.R.China
  4. College of Electronic Information and Electrical Engineering, Anyang Institute OfTechnology
    455000 Anyang Henan, P.R. China

Abstract

In complex terrain environments such as high mountains and hills, traditional agricultural machinery cannot accurately complete tasks such as crop management and harvesting. This paper used plant protection drones as carriers to study the observation content of crops during their navigation process. Aiming at the low accuracy of the traditional quaternion cubature Kalman filtering algorithm for the attitude estimation of the carrier nonlinear state model, a quaternon-based square root cubature Kalman filtering algorithm was proposed in this paper.The algorithm takes the attitude quaternion error and the gyro drift error as the state quantity, and measures the attitude quaternion of SINS/SLAM navigation. The square root cubature Kalman filter algorithm is used for pose estimation, which not only solves the standardization problem of traditional quaternion, but also reduces the state dimension and complexity of the square root UKF algorithm of traditional quaternion, and improves the numerical stability. Compared with the quaternion SRUKF and quaternion SRCDKF algorithm, the simulation results showed that the new algorithm estimated the error mean values of the roll angle, pitch angle and runt angle, which are 0.05°, 0.08°, and 0.03°, respectively. The error is the smallest, and algorithm accuracy is about 30% higher than the quaternion SRUKF-SLAM algorithm, and it has high filtering accuracy and numerical stability, and the best time-consuming performanc.

Key words

quaternion, state model, square root Cubature Kalman filter, attitude estimation, numerical stability

Digital Object Identifier (DOI)

https://doi.org/10.2298/CSIS240418058W

Publication information

Volume 21, Issue 4 (September 2024)
Year of Publication: 2024
ISSN: 2406-1018 (Online)
Publisher: ComSIS Consortium

Full text

DownloadAvailable in PDF
Portable Document Format

How to cite

Wang, D., Zhu, Z., Yu, L., Li, H., Tan, K.: Attitude Estimation of aircraft Based on Quaternion SRCKF-SLAM Algorithm. Computer Science and Information Systems, Vol. 21, No. 4, 1801–1822. (2024), https://doi.org/10.2298/CSIS240418058W