A Double-EKF Orientation Estimator Decoupling Magnetometer Effects on Pitch and Roll Angles

Abstract

Accurate orientation estimation using low-cost inertial and magnetic sensors is important. However, since the magnetometer measurements affect pitch and roll estimates in addition to yaw determination, the resultant accuracy reduction under magnetic disturbances is adverse for special occasions where high-precision pitch and roll estimates are essential. This article presents a double-extended Kalman filter (DEKF) orientation estimator with unit quaternion as output, which decouples magnetometer effects on pitch and roll estimates by decomposing the orientation into tilt quaternion and heading quaternion. The tilt quaternion, including pitch and roll information, is estimated by the first EKF where accelerometer and gyroscope measurements are processed and the inaccurate heading information is discarded. The heading quaternion, solely describing the yaw orientation, is determined by the second EKF, which fuses the vertical component of angular rate measurements and the horizontal component of magnetic measurements. True quaternion is denoted by the multiplicative of tilt and heading quaternions. The separate property of DEKF limits the influences of magnetic disturbances on yaw estimation, making the pitch and roll angles immune to them. Experiment results show that the proposed method solves the coupled disturbance problem without losing accuracy.