Earth velocity and rigid-body attitude estimation on SO(3) using biased measurements

Abstract

This article addresses the problem of simultaneously estimating: 1) the attitude of a rigid body on the special orthogonal group of order 3 ( \(\mathsf {SO}(3)\) ); 2) the Earth’s spin vector expressed in body-fixed coordinates; and 3) a pair of time-varying sensor measurement biases. The available sensor readings include biased angular velocity measurements collected from a set of high-grade rate gyros sensitive to the rotation of the planet and biased vector observations of some known inertial reference field. The estimation solution consists of a Lagrangian-based pseudo Kalman filtering routine, which is partially constrained to \(\mathsf {SO}(3)\) vis-á-vis the attitude. Most noticeably, the geometric relationship between the Earth’s angular velocity and the inertial field is leveraged to relax common practical, as well as theoretical, demands closely linked to conventional attitude estimation solutions, namely, the need for explicit body-fixed measurements of two inertial vector fields. The proposed algorithm is validated through a set of realistic simulations. Experimental results are also included to further demonstrate the performance of this strategy in a real-world application.