Adaptive Kalman filter for MEMS IMU data fusion using enhanced covariance scaling

Key words:  IMU state-space model · Role and pitch estimation · More · Attitude estimation · Adaptive Kalman filter · Covariance scaling

摘要:

Abstract:

MEMS (micro-electro-mechanical-system) IMU (inertial measurement unit) sensors are characteristically noisy and this presents a serious problem to their effective use. The Kalman filter assumes zero-mean Gaussian process and measurement noise variables, and then recursively computes optimal state estimates. However, establishing the exact noise statistics is a non-trivial task. Additionally, this noise often varies widely in operation. Addressing this challenge is the focus of adaptive Kalman filtering techniques. In the covariance scaling method, the process and measurement noise covariance matrices Q and R are uniformly scaled by a scalar-quantity attenuating window. This study proposes a new approach where individual elements of Q and R are scaled element-wise to ensure more granular adaptation of noise components and hence improve accuracy. In addition, the scaling is performed over a smoothly decreasing window to balance aggressiveness of response and stability in steady state. Experimental results show that the root mean square errors for both pith and roll axes are significantly reduced compared to the conventional noise adaptation method, albeit at a slightly higher computational cost. Specifically, the root mean square pitch errors are 1.1? under acceleration and 2.1? under rotation, which are significantly less than the corresponding errors of the adaptive complementary filter and conventional covariance scaling-based adaptive Kalman filter tested under the same conditions.