An adaptive quaternion particle filter (QPF) based on the generalized likelihood ratio test (GLRT) is proposed for aircraft attitude estimation in the presence of an anomalous measurement. The framework of the QPF is employed to guarantee quaternion normalization. To cope with an anomalous measurement when interference occurs, the proposed algorithm uses the GLRT to detect an anomalous measurement and determine the interference source. An adaptation scheme is used to tune the measurement noise covariance matrix after the interference source has been determined so that the algorithm can remain robust against interference. Numerical simulations are carried out to evaluate the performance of the proposed algorithm and compare it with the QPF algorithm. The results show that the proposed algorithm outperforms the standard one in attitude estimation accuracy under anomalous measurement conditions.
Read full abstract