Combinatory Attitude Determination Method for High Rotational Speed Rigid-Body Aircraft

Abstract

In this paper, we present a novel multisensor combinatory attitude determination method that enables high-accuracy measurement of the attitude of a high rotational speed rigid-body aircraft. We analyze the external moments of the aircraft during flight and develop the method using theoretical deductions based on the motion equations of a rigid body rotating around the centroid. The proposed method fuses the data measured from GPS, gyrometer, and magnetometer and uses the improved unscented Kalman filter (UKF) algorithm to perform filtering. First, appropriate assumptions and simplifying approximations are made for around-centroid motion equations of a rigid body according to the motion characteristics of the high rotational speed aircraft. Using these assumptions and approximations, the constraint equations between the Euler attitude angles and flight-path angle, trajectory deflection angle are derived to serve as the state equation. Second, the roll angle with error is calculated using the geomagnetic field model and the geomagnetic intensity measured by a three-axis magnetometer and then fused with the angular velocity information obtained from the gyroscope for constructing the measurement equations. Finally, the state equations are discretized using the Runge–Kutta method during the UKF prediction stage, improving the prediction accuracy. Simulation results show that the proposed method can effectively determine the attitude information of the high rotational speed aircraft, achieving high level of reliability and accuracy thanks to the combination of information from GPS, gyroscope, and magnetometer.