Efficient Sequential Attitude Estimation from Vector Observations

This paper presents a computationally efficient, sequential method for attitude matrix estimation using gyro and vector measurements. The method is based on a recently introduced, minimal-parameter third-order method for solving the orthogonal matrix differential equation in R(sup n). In the three-dimensional case, these third-order attitude parameters can be interpreted as temporal-integrals of the body-frame angular velocity components. A nonlinear algorithm is developed, which uses this minimal set of three parameters to estimate the nine-parameter direction-cosine matrix. Having an extremely simple kinematic equation, these parameters render the resulting estimator highly computationally efficient. An orthogonalization procedure, incorporated into the measurement processing stage, enhances the accuracy and stability of the resulting algorithm, yet retains reasonable simplicity. The performance of the estimator is demonstrated via a Monte Carlo simulation study.