Square-Root Cubature Kalman Filter Based on H∞ Filter for Attitude Measurement of High-Spinning Aircraft

Abstract

A novel H∞ filter called square-root cubature H∞ Kalman filter is proposed for attitude measurement of high-spinning aircraft. In this method, a combined measurement model of three-axis geomagnetic sensor and gyroscope is used, and the Euler angle algorithm model is used to reduce the state dimension and linearize the state equation, which can reduce the amount of calculation. Simultaneously, the method can be applied to the case of measurement noise uncertainty. By continuously modifying the error limiting parameters to update the measurement noise estimation, the filtering accuracy and robustness can be improved. The square-root forms enjoy a consistently improved numerical stability because all the resulting covariance matrices by QR decomposition are guaranteed to stay positive semidefinite. The algorithm is applied to the simulation experiment of attitude measurement with the combination of geomagnetic sensor and gyroscope and compared with the results of Unscented Kalman filter, cubature Kalman filter, square root cubature Kalman filter, and singular value decomposition cubature Kalman filter, which proves the effectiveness and superiority of the algorithm.