A gyro-free quaternion-based attitude determination system suitable for implementation using low cost sensors

Abstract

Attitude determination systems that use inexpensive sensors and are based on computationally efficient and robust algorithms are indispensable for real-time vehicle navigation, guidance and control applications. This paper describes an attitude determination system that is based on two vector measurements of non-zero, non-colinear vectors. The algorithm is based on a quaternion formulation of Wahba's (1966) problem, whereby the error quaternion (q/sub e/) becomes the observed state and can be cast into a standard linear measurement equation. Using the Earth's magnetic field and gravity as the two measured quantities, a low-cost attitude determination system is proposed. An iterated least-squares solution to the attitude determination problem is tested on simulated static cases, and shown to be globally convergent. A time-varying Kalman filter implementation of the same formulation is tested on simulated data and experimental data from a maneuvering aircraft. The time-varying Kalman filter implementation of this algorithm is exercised on simulated and real data collected from an inexpensive triad of accelerometers and magnetometers. The accelerometers in conjunction with the derivative of GPS velocity provided a measure of the gravitation field vector and the magnetometers measured the Earth's magnetic field vector. Tracking errors on experimental data are shown to be less than 1 degree mean and standard deviation of approximately 11 degrees in yaw, and 3 degrees in pitch and roll. Best case performance of the system during maneuvering is shown to improve standard deviations to approximately 3 degrees in yaw, and 1.5 degrees in pitch and roll.