An Adaptive Complementary Kalman Filter Using Fuzzy Logic for a Hybrid Head Tracker System

摘要

In this paper, a sensor fusion algorithm that integrates gyroscope and vision measurements using an adaptive complementary Kalman filter is proposed to estimate the attitude of a hybrid head tracker system. In order to make the filter more tolerant to vision measurement fault and more robust to system dynamics, an adaptive fading filter is implemented to the sensor fusion filter, and fuzzy logic is applied to adjust the fading factor, which adapts a Kalman gain of the sensor fusion filter. For recognizing the dynamic condition of the system and vision measurement fault, the normalized square error of attitude and the norm of gyroscope output with designed membership functions are used. The performance of the proposed algorithm is evaluated by simulations. It is confirmed that the proposed algorithm has better performance than the conventional algorithms in high-dynamic conditions and vision measurement fault case.